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CHAPTER 1 


INTRODUCTION 


Single gimbal Control Moment Gyros (CMGs) are angular momentum storage 
devices that can apply torque to a vehicle without expending consumables. Single gim- 
bal CMGs have significant advantages over double gimbal CMGs in spacecraft attitude 
control; i.e. mechanical simplicity and ability to provide torque amplification. Despite 
these advantages, single gimbal CMGs are plagued by singular states which preclude 
torque generation in a certain direction, and thus lead to loss of three-axis control of 
the vehicle. These conditions, if not properly addressed, severely limit the usable 
momentum capability of the CMG system. Hardware limits on gimbal rates entail that 
neighborhoods of singular states be considered in the control law design, since they 
represent regions of limited torque capability, thus require high gimbal rates to gener- 
ate the requisite torque. 

Although the extra degrees of freedom provided by adopting redundant CMG sys- 
tems can be used to avoid these singular states, the use of redundant CMG systems 
does not elliminate the singularity problem. Since the specific arrangement of the gim- 
bals affects the type and number of singularities, one may reduce the possibility of 
encountering singular states within the CMG momentum workspace through modifica- 
tions and improvements in CMG design. Control laws designed to manage single gim- 
bal systems, however, must nonetheless account for these singular states in order to 
extract maximum performance. 


A method for resolving this redundancy is required for the proper formulation and 
design of spacecraft attitude control systems, which define a required output torque 
from the single gimbal CMG system as a function of the state of the vehicle. These 





methods are refered to as Steering laws because they address the kinematic relationship 
between gimbal rates and total CMC output torque. Intelligent design of a Steering 
law warrants careful examination of the singular states mentioned above. These two 
themes comprise the central thrust of this thesis. 

The general objective of this thesis is to study the control of kinematically redun- 
dant single gimbal CMGs. To this end there are two major objectives. The first goal 
includes the detailed analysis of singular states and development of a method that dis- 
tinguishes between different types of singularities. The second goal is the development 
of a general Steering law for 4-Pyramid mounted single gimbal CMGs. An overview of 
the thesis is presented below: 

In Chapter 2, single gimbal CMG fundamentals will be reviewed, and the mechan- 
ical analog to the CMG system, the robotic manipulator, will be presented. A simple 
method of generating an orthogonal null-space basis to the Jacobian matrix will also 
be given. 

In Chapter 3, the control architecture for spacecraft equipped with single gimbal 
CMGs will be reviewed. The desirability to accomodate occasional errors in torque 
delivered by the CMG system will b.; discussed. 

In Chapter 4, the singular states of single gimbal CVIGs will be classified, and a 
test for null motion near a singular configuration will be presented. Examples of differ- 
ent types of singularities will be presented for both the CMG system and a planar 


. 

manipulator, and the relationship between the singularity measure and the null-space | 

i 

of the Jacobian matrix will be examined. • 

i 

I 

In Chapter 5, various torque-input Steering laws will be reviewed, and alternative 
singularity avoidance methods will be proposed. Performance of these candidate meth- ' 

ods will be examined and compared in computer simulations using the 4-CMG system. 

In Chapter 6, a method of singularity avoidance based on the SR-in verse will be 

proposed. This approach will be compared to the methods introduced in Chapter 5, i 

i 

and simulation results will be presented to verify its performance. 

Finally, in Chapter 7, concluding remarks and recommendations will be given. 
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CHAPTER 2 


SINGLE GIMBAL (SG) CONTROL MOMENT GYRO (CMG) FUN- 
DAMENTALS 


2. 1 CHARACTERISTICS OF SG SYTEMS 


A single gimbal CMG consists of a flywheel spinning at a constant rate about an 
axis that is gimballed to allow changes in the spin direction. An example of such a 
device is shown in Figure 2-1. The CMG is a constant magnitude angular momentum 
storage device since the flywheel rate is held constant. As can be seen from the figure, 
the momentum vector is restricted to lie in the plane of rotation. The gimbal is rigidly 
attached to the spacecraft and is able to rotate about the gimbal axis. A coordinate 
system attached to each gimbal is defined by the orthonormal basis vectors: 



A 

where = Unit vector along gimbal axis 

A 

h l = Unit vector along angular momentum 

A A A 

j l — Unit vector given by u l x /i. 


For each CMG, the gimbal angle B is measured with respect to the reference coordi- 
nate frame with positive angular displacement defined by the gimbal axis direction. 
The reference frame is defined by the initial orientation of the gimbal-fixcd frame and is 

f A A A 1 f A A \ 

denoted by 0,, h, \ j, 0 j . The expression for the unit vectors | h , j, j in this refer- 
ence frame is given by: 


A A A a 

h: — cos 6. hi 0 + sin B t j i 

A A .. A > 

jt = ~ sin t) t ^ + cos 0J ( - 
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This is shown in Figure 2-1. 


For a system of n single gimbal CMGs, the total system angular momentum is the 
vector sum of the individual momenta, i.e. 


h(0) = ^4(0/) 

<=1 


( 2 - 2 ) 


where 


h($) = Total system angular momentum 
hi(di) = Angular momentum of I th CMG 
= i th gimbal angle 


The expression for the angular momentum of the i‘“ CMG with respect to the reference 
coordinate frame is given by: 


4 = 44 

where Ir = Magnitude of t th CMG angular momentum 

2.2 PRINCIPLE OF OPERATION 

The principle governing the operation of a C MG system is that torque is the time 
rate of change of angular momentum. Since the magnitude of the angular momentum 
of a CMG is constant, torque is produced by rotation of the momentum vector. The 
direction of the output torque is given by the right-hand rule, i.e. gimbal axis 'crossed" 
into momentum direction. This is shown in Figure 2-2. The CMG output torque is 
given by: 





X = h - fix h 


As in the case of the angular momentum, the output torque of a CMG lies in the 
plane of rotation. It is also clear that the torque direction is perpendicular to the 
momentum direction. This type of device can be thought of as a two-sided actuator 
due to its ability to produce a torque in opposite directions, as opposed to an individ- 
ual jet which can provide a torque in only one direction. 


6 
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► t 

- — dh 

Figure 2-2. CMG Output Torque 


For spacecraft three-axis control, at least three single gimbal CMGs are required. 
If the CMG system in question has more actuators (gimbals) than rotational degrees of 
freedom, it is termed redundant. The degree of redundancy is given by the difference 
between the number of CMGs and the number of degrees of freedom to be controlled. 

2.3 MECHANICAL ANALOG 


In order to visualize motions of a CMG 


system, the concept of the momentum 


linkage [1] is introduced and the analogy to a robotic manipulator is proposed. Con- 
sider the CMG system as an open-loop kinematic chain or linkage made up of equal 
length momentum links, placed in arbitrary order, with one link attached to a 
grounded pivot. The length of each link is given by the magnitude of each CMG 
angular momentum, considered equal in this case. The individual links are constrained 
to rotate in a fixed plane determined by the corresponding gimbal axes. The moti- 
vation for this concept derives from the expression for the total angular momentum of 
a CMG system as the vector sum of individual momenta. The summation operation in 
this case is commutative. For a robotic manipulator, the end-effector position is the 
vector sum of the individual link displacements. It is proposed that a correspondence 
exists between link displacements for a manipulator and individual momenta for a 
CMG system. The first part of the analog then, is the correspondence between angular 
momentum for a CMG system and displacement for a manipulator. 

The momentum linkage can be defined as a commutative linkage with links made 
up or individual momenta, A, [1], The total system momentum corresponds to the 
position of the momentum linkage tip in momentum space which is a Euclidean 
3-space b?. We can think of the momentum linkage as a man.pulator whose end-efiec- 
tor oosition corresponds to total angular momentum. The workspace of this manipula- 
tor naturally corresponds to the momentum volume and the boundary of the 
workspace is defined as the momentum envelope or locus of all points traced out by 
the maximally stretched momentum linkage. An example of the momentum envelope 
for 4- Pyramid mounted CMGs ,s shown in Figure 2-3, [1] . The holes or funnels rep- 
resent windows on the envelope. These regions represent unattainable momentum 
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states, because the normal to the window is aligned with a gimbal axis. The funnel then 
is part of the boundary to the momentum volume. 

The momentum linkage concept was used in [1] to describe the total angular 
momentum of a CMG system and to describe the boundary surface or momentum 
envelope as the surface generated by the stretched momentum linkage. The linkage 
concept was also used to describe null motion of a CMG system, u'hich are discussed 
in the next section. 

2.4 TORQUE AND NON-TORQUE PRODUCING MOTIONS 

I he output torque for a system of n CMGs is given by the time rate of change of 
the total system angular momentum relative to a frame of reference of interest, in this 
case the spacecraft body-fixed coordinate frame, which is given by: 


1 = h(9) = J(0) e 


(2-3) 


where J{&) _ £ 7i t^i ), ■•■■,j n W n ) ], Instantaneous Jacobian matrix (3 x n) 
„ dh dhj 

Jo ' ; ' — v , — ■ Jacobian columns 

cd t dO, 


It is seen that the total output torque for a system of CMGs is given by the sum of 
the individual gimbal torques. Extending the momentum linkage concept to this case, 
the motion (rotation) of each link corresponds to the output torque for each CMG. 
Io draw the analogy to the robotic manipulator, it is noted that for the manipulator 
the cnd-cfTcctor velocity is the vector sum of the individual link velocities. Just as the 
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individual link displacements correspond to angular momenta, link velocities corre- 
spond to individual CMG output torques, thus the total output torque for a system of 
CMGs corresponds to the velocity of the momentum linkage tip in B. So far it has 
been established that for the mechanical analog to a CMG system (the robotic manip- 
ulator), link lengths correspond to magnitude of individual CMG angular momenta, 
and end-effector position and velocity to total angular momentum and total output 
torque for the CMG system. What remains to complete the analogy is to show an 
equivalence in the singularity problem for a manipulator and the CMG system. 

We now turn our attention to torque and non-torque producing link motions (or 
gimbal rates). First, the linkage concept will be used to describe torque and non-torque 
producing motions, and then an analytic description in terms of gimbal rates will be 

presented. 

Using the momentum linkage concept, it is seen that the total output torque of a 
CMG system corresponds to the velocity of the linkage tip. If the linkage tip is station- 
ary, no net torque is applied to the spacecraft. Torque producing motions are those 
link motions for which the tip of the momentum linkage moves. On the other hand, 
relative motions of the links that do not affect the location of the linkage tip do not 
produce a net torque on the spacecraft, and are termed non-torque producing motions. 
These motions can be visualized by treating the linkage tip as a virtual pivot, which 
fixes the tip location, and moving the remaining links. The linkage can attain any 
kinematically admissible configuration or closure-, by relative link motions as long as 
the linkage tip remains stationary. These relative motions are termed 'admissible'. An 
example of such a motion for the mechanical analog is shown in Figure 2-4. The cho- 
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Figure 2-4. Example Of Null Motion For Mechanical Analog 



To express torque producing and non-torque producing motions in terms of gimbal 
rates, we can see that torque producing motions consist of gimbal rates that result in 
movement of the linkage tip, and gimbal rates that do not afTect the location of the 
linkage tip are called non-torque producing rates. This concept is naturally expressed 
by the general solution to the non-homogeneous system of linear equations in (2-3). 
The general solution can be represented as: 



ft — ftp "I - 

where 6 P - Particular solution ( J(Q) d P — T) 

B h = Homogeneous solution ( J(6) d H =q) 

The particular solution expresses the torque producing gimbal rates, and the homoge- 
neous solution the non-torque producing gimbal rates or "null motion". The term "null 
motion" arises from the fact that the solution to the homogeneous system consists of 
gimbal rates that lie in the null-space of the Jacobian matrix, and therefore produce no 
instantaneous torque ("instantaneous" because the Jacobian matrix is evaluated using 
the instantaneous values of the gimbal angles). These null motions" are the variations 
of "admissible" relative link motions. This property of null mot.on can be exploited to 
reconfigure the linkage or momentum state of the C\1G system without altering its 
total momentum. Correspondingly, torque producing g.mbal rates lie in the row space 
or orthogonal complement of the null-space of the Jacobian. The solution-space to the 
non-homogeneous problem can be regarded as 2-dimensional, with an orthogonal basis 
consisting of the torque and non-torque producing solutions. 


The system of linear equations (2-3) can be solved as long as the rank of the Jaco- 
bian matrix is 3. If the rank is less than 3, the CMC system cannot produce a torque 
along all three axes of the spacecraft, and three-axis controllability is lost. The CMC', 
system is termed singular when the rank of the Jacobian is less than 3, i.c. the matrix is 
singular. This essentially defines the singularity problem for CMGs. In this situation 
no output torque is available along an axis or direction. This information will now be 
used to establish the equivalence of the singularity problem of a CMC system to that 
of a corresponding manipulator. 






We have seen that velocity for a manipulator is analogous to torque for a CMG 
system. The Jacobian matrix tor a manipulator transforms joint rates to end-efTector 
velocity whereas for a CMG system the Jacobian transforms gimbal rates to torque. 
When the manipulator Jacobian loses rank (becomes singular), motion in a particular 
direction is not possible. An example of a singular configuration for a planar manipula- 
tor is shown in Figure 2-4. The singularity analog is established by noting that for a 
manipulator no motion is possible in a certain direction, whereas for a CMG system no 
torque is possible in a certain direction. The singularity problem for both systems is 
similar. Of course the elements of the manipulator Jacobian will not be the same as 
those for a CMG. although the general structure is the same. A summary of the anal- 
ogy between a manipulator and a CMG system is given in Table 2-1. The conclusion 
from the above discussion is that manipulators and CMG system have similar singular- 
ity problems and results from one area may be applicable to the other. 

2.5 EXAMPLES OF SG CMG SYSTEM AND PLANAR MANIPULATOR 

In order to clarify some of the concepts presented in the previous sections, specific 
examples of a CMG system and a planar manipulator will be presented in this section. 
We will consider a 4-Pyramid mounted SG CMG system and a planar 3-link manipula- 
tor. These particular examples will be used throughout, to illustrate concepts and appli- 
cations. 

2.5. 1 4-Pyramid Mounted SG CMG System 

The 4- Pyramid type CMG system consists of 4 single gimbal CMGs each posi- 
tioned on one face of a 4-sided pyramid such that the momentum vector lies in this 



Table 2-1. Analogy Of Manipulator To SG CMG System 


MANIPULATOR 


<t> 


SG CMG SYSTEM 


Position x - x(q) 

Velocity x * J(q) q 


Momentum * h(0) 
Torque h • J(0) 0 


Acceleration x ■ J (g) cj + J (q) cj Torque h * J(d)d+ j(0) 6 


Singularity 


No motion possible In a certain 
direction 


No torque possible in a certain 
direction 


h 


plane. An example of this mounting configuration in the spacecraft body fixed coordi 
nate frame { X, Y,Z } is shown in Figure 2-5. If the skew angle p equals 54.73 degrees 
the gimbal axes lie along the main diagonals of a cube. 


We will express the angular momentum of each CMG with respect to the space 
craft coordinate system. These are given bv: 


— cP sin 0| 
h\ — h cos 

sP sin 0, 

cp sin ft 3 
hi — h — cos ft 3 
sp sin ft 3 

- cos d 2 
hi — h — cp sin ft, 
sP sin ft 2 

cos # 4 

Ik = h cp sin # 4 
sP sin ft A 

where sP = sin P 



eft = cos p 

h — Angular momentum magnitude 


The total angular momentum of this system is: 


h — h\ + h 2 + h 3 + hj ( 2 - 4 ) 

The output torque of the CMG system is obtained by differentiating (2-4) in the space- 
craft frame of reference: 


b = k + h 2 + 4 + h A = J(6) ft 


(2-5) 


The Jacobian matrix has the form: 






i 

p » 

8 i 
r i 




7(0) ■= h 


— c(i cos 0, 
— sin 0, 
sP cos 0, 


sin 0 2 
— cP cos 6 2 
sp cos 0 2 


cP cos 0 3 
sin 0 3 
sP cos d 3 


— sin 0 4 
cP cos 0 4 
s/? cos0 4 


( 2 - 6 ) 


A method for constructing the null-vector(s) of the Jacobian matrix using the concept 
of the generalized cross-product in ^-dimensions is presented in the next section. It 
will be shown that much insight about the properties of the null- space can be gained 
through this construction method. 

2.5.2 Null-Space Of Jacobian Matrix And The Generalized Cross-Product 


It has been shown that the null-space of the Jacobian contributes the homogene- 
ous or non-torque producing solution to (2-3). The null-space basis vectors arc essen- 
tial, because the homogeneous solution cu : be written as a linear combination of these 
vectors, as well as providing more insight into the kinematics of the C\1G svst m. The 
dimension of the null-space or nullity [2] is: 

n(J) — n ~ r{J) (2-6) 

where n{ J) = Nullity of Jacobian 
r(J) = Rank of Jacobian 

n = Dimension of Jacobian domain space 

For this CMG configuration, n = 4. When the Jacobian is non-singular, its nullity is 
1, and when it is singular its nullity is 2 (due to non-coplanar gimbal mounting). The 
null-space basis vectors can be determined by row-echelon reduction of the Jacobian to 
produce its dependent columns, which then can be used to span the null-space. This is 
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a numerical method and docs not provide a closed form expression for the basis vec- 
tors. A closed form expression can be generated by use of the generalised vector cross- 
product in e-dimensions [I] . This method generates an orthogonal basis by forming 
n-,ark(J) vectors that are orthogonal to the linearly independent mw vectors of the 
n and to each other. This approach is preferred over the row-echelon method: 

not only because a closed form solution is obtained, but also for the general insight 
that it provides about null motion. 



To motivate this approach, it is noted that the rank of a matrix is given by either 
the column rank or the row rank, since the column rank equals the row rank [2], Let 
y denote an tt-dimensional null-vector of MS) . This vector must satisfy fit), ,. = „ 

I or the case when M) ,s nonsingular. ,t has three linearly independent row and col- 
umn vectors, and rot ,*,/) . 3. Therefore, the nullity is and v must be orthogonal 
to the tow vectors of Ad). To carry out the cross-product m ,, -dimensions, ,t ,s noted 
that the cross product ol two vectors in 3-dimensions can he written in terms of their 
components as a 3 x 3 determinant. These components are the 2 X 2 minors of tins 
3 x 3 matrix. Let us illustrate this by an example. Consider two 3-d, mens, onal vectors 

d. t expressed in a rectangular coordinate system with unit vectors {?./.£}. | hen 
we can write: 


A A A 

- a x i -f a y j -f a : k 

, A A A 

- i + h v j 4 - b.k 


ic cross-product of u und h is given by: 
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a x b = ( a y b 2 - afo y ) i + ( a z b x - a x b z )j + ( a x b y - a y b x ) k 
This result can be written as the determinant 
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A 

A 
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A A 
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a x b = 

<*x 

a y 

a z 

= 

i J 

k 



* 



£x £y 
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We can see that the cross-product can be written in terms of the 2x2 minors of the 
determinant matrix: 


AAA 

q x b — .V / 3 1 — \I 2 j + .V/j k 

where \I X = | c x c y | first minor 

M, — | c x r, | second minor 

M j = | c v c. | third minor 


The null-vector for the case of nonsingular J(d) can now be computed using this 
method. Let the 4-dimensional gimbal angle space d be defined by the unit vectors 

| A A A A ) 

1 6 { , d 2 , 0j, j . The cross-product in 4-dimensions operates on the 3 linearly mdepend- 


determinant matrix 

is ! 


A 

A 

A 

A 


0, 

0; 

03 

04 


h 

>2 

/3 

74 


( 2 - 8 ) 


In terms of the Jacobian minors, the null-vector becomes: 
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(2-9) 


v = ,v/ 4 e { - >/ 3 e 2 + ,v/ 2 0 3 - .v/, S 4 

or 

V/ 4 ' 
v- 

,V/ 2 

- v/ 3 

where .V/, = | y, y 2 y 3 | 

• U 2 = I 7i 72 7 j I 

U 3 = I 7 1 73 74 I 

V/ 4 = ! 72 7 3 74 I 

This method can also be used when the Jacobian is singular. In that case, J(d) will onlv 
have two linearly independent row vectors, thus in order to apply this method, these 
row vectors must first be determined. The next step would be to take the 3-dimcnsionaI 
cross-product using only the first three elements of the row vectors in order to generate 
a vector in 3-space that is orthogonal to the truncated row vectors. Then, a 4-dimcn- 
sional cross-product is taken using the two linearly independent row vectors and the 
vector just generated with a zero fourth element. In this way, the two orthogonal null- 
space basis vectors arc generated. We can apply this approach in a similar fashion to 
systems with more than 4 CMGs. 

Considerable insight can be gleaned from the form of the null-vector and the Jaco- 
bian minors. In general, this expression (2-9) for the nuil vector is valid when 7(tf) is 
nonsingular, and it is a function of the gimbal angles. The minors of the Jacobian 
matrix have a very interesting physical meaning. A minor is zero when the columns of 
the minor matrix or 3 x 3 Jacobian sub-matrix arc dependent. This means the sub-ma- 
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tnx is singular, and its columns do not span B. The rank of this submatrix has 
dropped from 3 to 2. Physically, it means that the 3 CMGs corresponding to this sub- 
matnx can no longer produce torque along all three spacecraft axes, hence three-axis 
controllability is lost for this CMC sub-system. We can thus think of the minors as 
controllability tests for sub-systems of 3 CMGs taken together according to the col- 
umns in the corresponding minor. For example, sub-system 1 corresponding to A/, 
would be comprised of CMGs 1, 2, and 3. It is clear that when all 4 sub-systems lose 
three-axis controllability, the spacecraft is not controllable by the CMG system. An 
alternate statment is that the rank of a matrix is the order of the largest nonsingular 
square sub-matrix formed from this matrix [2], Thus the Jacob, an is singular when all 
3 x 3 nunors are 0, i.c. there is no nonsingular sub-matrix of order 3. It is also evident 
that when one of the minors is zero, one of the elements of the null-vector is zero, 
which implies that no null motion is available from the corresponding CMG. 



2.5.3 Planar 3- Link Manipulator 

A planar 3-link manipulator with 1 degree of redundancy ,s shown in Figure 3-6. 
The choree for generalized coordinates in this case are the absolute joint angles. This 
choree of coordinates ,s made to keep the analogy to the CMC, system transparent. 
The link length choice is dictated by the requirement that the manipulator possess the 
same number of equivalent types of singularities. We could have chosen equal length 
links lor the manipulator to match the chotce of equal magnrtude angular momenta 
but this would have resulted in a manipulator that would not possess all types of sin- 
gularilics encountered the CMG system. Specfically. internal elliptic type srngulan- 
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ties would not be encountered for this manipulator (the various types of singularities 

i 

will be defined in Chapter 4). 


Y 



Figure 2-6. Planar 3- Link Manipulator 


The motion of the manipulator is described by the generalized coordinates 
{ <7i. <7 j> <7j } relative to a fixed coordinate frame { X,Y }. The displacement of the end- 
efTector is denoted &, while the individual link displacements are defined by x, . The 
link displacements are: 


f cos < 7 , 1 


r cos q 2 ' 

| 

r cos <73 1 

* " 2 '1 sin?, J 

*1 = 1 

L sin <h . 

=£3 = 1 

L sin ^3 J 
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where l = Link length 
The cnd-effector position is given by: 

- = -> + ^2 + * (2-10) 
The end-effector velocity thus becomes: 

- = £\ + £ 2 + i' 3 = J(q)q (2-11) 

The Jacobian matrix for the manipulator is: 

%) = /[ “ 2s " , ‘ ?l ~ sinft - sin * 1 

|_ 2 cos q x cos cos q 3 

Comparing the manipulator results to the 4-CMG system, we can easily see an analo- 
gy. Observe that the manipulator Jacobian has a similar form to the CMC Jacobian 
with this choice of generalized coordinates. Specifically, the manipulator columns are 
the partial derivatives with respect to the generalized coordinates of the individual joint 
displacements, as was analogously true for the CMC, system. It is also noted that li- 
the Jacobian is differentiated again, with respect to the generalized coordinates, its col- 
umns will be the negative of the link displacements. This is due ,0 the cyclic nature of 
the trigonometric functions, governing the generalized coordinates, hence is also true 
for the CMC Jacobian. Finally. „ ,s emphasized that the planar manipulator of 
Figure 2-6 is no, the exact analog ,0 the 4-CMG system because its Elliptic type inter- 
nal singularity is actually a degenerate Hyperbolic singularity. T his will become clear ,n 
Chapter 4. The exact analog can be obtained by projecting the gimbal morions ,n the 
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3 orthogonal planes formed by the spacecraft coordinate system. A manipulator with 
varying link lengths can then be defined such that its motion recovers the motion of 
the gimbals in each plane. A simple example would be to project the motion of gimbal 
#1 in the X— Y plane. The path of the gimbal in this plane is elliptic because the pro- 
jection varies. A link with varying length can be used to duplicate this motion in the 

plane. 


The null-vector for the manipulator Jacobian can also be constructed using the 
generalized cross-product approach. Let the 3-dimensional joint angle space be defined 
by the unit-vectors {$„&,$,}. The cross-product in 3-dimensions operates on the 2 
linearly independent rows of J(q). The determinant matrix is: 


AAA 

<7l <72 </3 

j_\ h Jj 


(2-13) 


In terms of the manipulator Jacobian minors, the null-vector becomes. 


y = V / 3 <?, - .V / 2 q 2 + V/, % 




i ilijjpj nil HP', , II..' « 
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Equivalent comments apply to the manipulator null-vector as for the CMG null- 
vector. The physical meaning of the minors in this case represents relative folding of 
the links. When a minor has 0 value, the columns of the corresponding sub-matrix of 
order 2 are not linearly independent; the sub-matrix has rank 1. This implies that the 
velocity capability of these two links is restricted to a line rather than a plane whenever 
the minor is nonzero, therefore the links are colinear or folded. The value of each 
minor thus represents the degree of folding of the corresponding pair of links. In this 
case there are 3 distinct combinations of pairs of links; when all three combinations are 
singular, the Jacobian is also singular, thus motion is restricted to a line. The general 
concepts of controllability, capability for null motion, etc. naturally carry over from the 
previous discussion about the CMG Jacobian null-space and will not be repeated here. 
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CHAPTER 3 


SPACECRAFT CONTROL ARCHITECTURE 



3.1 SPACECRAFT ATTITUDE MANEUVERS 

Spacecraft attitude control may be realized through angular momentum exchange 
between the spacecraft and momentum storage devices such as single gimbal CVIGs, 
which can be used to provide control torques for attitude control of space vehicles. A 
most common example is the reorientation of a spacecraft. The most general pre- 
scription for an attitude maneuver is to specify the desired final state (attitude and rate) 
given the initial state of the spacecraft. The controller must then be able to satisfy this \ 

request using CVIGs as actuators. 

I 

• ; 

An attitude maneuver can be accomplished in various ways. The methods to * 

accomplish these maneuvers can be classified as kinematic or dvnamic, depending on 

, 1 

the criteria used. An example of a kinematic approach is an eigenaxis or single-axis j j 

rotation, because this results in the smallest rotation angle required for the maneuver. 

A single-axis feedback controller based on this approach is used on the Space Shuttle 
[3], On the other hand, the ORA controller [4] is an example of a dynamic approach. 

It uses a feedforward- feedback model-following controller structure for fuel-optimal 

maneuvers, w'hich arc not constrained to rotations about a single axis. This approach ' 

reduces fuel consumption, hence it is superior to the kinematic method. For the case 

of spacecraft with CVIGs, a model following controller (dynamic method) could also be 

used, as long as the model or desired trajectory is constructed in a way that reflects the 

unique properties of CVKi actuated spacecraft. 




One method of generating a desired trajectory that is globally "optimal" in a cer- 
tain sense, using the calculus of variations, is described in [5]. The optimization prob- 
lem requires the design of an optimal terminal controller, with only some of the states 
specified at a fixed terminal time. These specified states are chosen to be the spacecraft 
initial and teminal attitude and rate. The assumption of no external torques implies 
that the terminal CMG state is not constrained, since that would violate conservation 
of angular momentum for the combined system. 

Performance criteria of interest include minimization of gimbal rates, minimization 
of final spacecraft state error from the desired value, and maintaining CMG 3-axis 
controllability over the entire trajectory. Redundancy resolution can be accomplished 
in a global sense by parametrizing CMG 3-axis controllability over the whole space- 
craft trajectory'. Solution of this problem, however, is very' difficult because some of the 
Lagrange multipliers have no boundary conditions at either end (i.e. initial and termi- 
nal conditions), since we have specified the values of the corresponding states at both 
ends. An intial control history is required to solve this optimization problem. 

To represent the attitude of a spacecraft, Euler parameters { rj, c } or quaternions 
will be used. Let the underscore represent a vector expressed in the spacecraft fixed 
frame. The rate of change of the Euler parameters is given by [6]: 

1 T 

n = -rrt QJ 

, (3-1) 

£ = |[ £ X f ,1> 


Let q represent the quaternion. 
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then we can rewrite (3-1) as: 


q = E{q) CO 


1 . 

i' 

j' 


V 

4 

}\ 


The equations of motion for the combined spacecraft-CMG system are obtained from 
the total angular momentum expression. Let the superscript 1 denote a quantity 
expressed in an inertial frame. The total angular momentum expressed in an inertial 
frame is given by: 


Ut = II 1 + h l 


where H 1 = Spacecraft angular momentum ( H l = I a/ ) 
h 1 = Total CMG angular momentum 

Expressing the time rate of change of the absolute total angular momentum of the 
combined system in the spacecraft fixed body axes, we obtain: 

il + OJ x II + h + o)X h = T (3-4) 

where T = External torques on spacecraft 

Rewriting (3-4) with h = Jd , and including (3-2) we obtain the dynamical equations 
governing this system: 


? 


(3-5) 


q = E{q)o) 

& = “ I_1 [ Qi x ( Ia> 4- h(6 ) ) ] - I -1 J(d) 0 + [ _1 J 


3.2 CONTROL ARCHITECTURE 


Attitude maneuvers of spacecraft equipped with CMGs are usually accomplished 
using a dual-level control architecture. This is because we can consider the attitude 
maneuver as consisting of two parts; first, the necessary torque required from the 
C.MG actuators to accomplish the maneuver must be determined, and second, this tor- 
que must be generated by the redundant system of CMGs. These two levels of the 
controller are defined as: 

a) Outer Control Loop 

b) Inner Control Loop 

I he general objectives of the control system for the combined spacecraft-CMG system 
can be stated as: 


a) Spacecraft reorientation accomplished using SG CMGs. 

b) CMG system must supply a commanded torque while avoiding singular config- 
urations. 

c) Spacecraft controllability must be maintained at all times 




k \ 


It has been shown that single gimbal CMG systems are plagued by singular states. 
For this reason, the Inner Control Loop must be capable of generating the required 
torque while simultaneously avoiding singular configurations. This is not an easy task. 
This problem might be made more tractable if the Outer Control Loop design takes 
this adverse feature of single gimbal CMGs into account; specifically, the design of the 
Outer controller must tolerate occasional errors in torque delivered by the CMG sys- 
tem, or limit the CMG torque command to avoid approaching vicinities of singular 
CMG orientations. The capability of accomodating errors in the torque request, is 
required due to reduced effectiveness of the CMG system near singular configurations. 
The Outer controller should also not constrain the CMG system to produce a given 
torque if this can lead to a singularity which the Steering law is not capable of avoid- 
ing. !n addition, the non-spherical nature of the SG CMG momentum envelope must 
specifically be taken into account for maneuvers which move the CMG system near 
saturation. 

All currently proposed SG CMG Steering laws (including those presented in this 
thesis) are unable to guarantee continuously flawless singularity avoidance, although 
various techniques (discussed in Chapters 5 and 6) do aid in reducing singular encount- 
ers. Because of this, any Outer controller must be prepared to occasionally deal with 
singularity related phenomena as discussed above. For reorientation maneuvers, the 
vehicle trajectory may be as general as possible, since the only constraints are the two 
boundary conditions; the initial and final states of the spacecraft. The choice of inter- 
mediate points is arbitrary, and thus may be chosen, if required, to aid in avoiding sin- 
gular CMG configurations. 
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3.3 OUTER CONTROL LOOP 

The function of the Outer Control Loop is to generate torque commands that 
accomplish the spacecraft attitude maneuver. Two pcssibilites for this controller were 
mentioned in the previous section. The model following controller can be implemented 
m different ways; two examples are the Si, ding Mode Controller (SMC) and optimal 
■racking method. An example of the Sliding Mode approach applied to spacecraft 

using CMOS can be found in [7], where the control input x is defined as the output 
torque of the CMC system: 

i = J{6) e 

The advantages of this approach are real-time implementation and a globally stable 
con, toller based on Lyapunov stability analysts, despite the presence of model tmpre 
cision and disturbance torques. 

A derivation of the optimal tracking method for spacecraft using CMGs can be 
found in [5], The solution to the tracktng problem leads to a full-state feedback control 
law where the optimal control has a feedforward-feedback structure. The major advan- 
tage of this approach is that performance criteria of interest can be included m the 
object, vc function. This approach is not considered real-time tmplemcntafcle however. 

stnee it requires numcncal solution (an initial control history is required to start the 
numerical process). 
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3.4 INNER CONTROL LOOP 


The function of the Inner Control Loop is to generate gimbal angle rate com- 
mands that cause the CMG system to produce the desired torque requested by the 
Outer Control Loop. It must also resolve the redundancy present in the CMG system. 
In the literature, this is usually referred to as a Steering law. This is not the only 
approach available. The Steering law may also be formulated to generate gimbal angle 
commands in response to angular momentum requests [8]. The Steering law thus 
exploits the kinematic relationship between CMG gimbal rates and the rate of change 
of total CMG angular momentum in the rotating frame of reference (spacecraft body 
fixed frame). 

The requirements that a successful Steering law must meet are: 

a) Generate the required torque. 

b) Steer the gimbal angle trajectories away from undesirable configurations. 

c) Meet any constraints placed on the CMG system, such as maximum gimbal 
rates, gimbal stops etc. 

.An undesirable configuration is one for which the CMG system is unable to produce 
any torque along a particular direction in P . This is equivalent to loss of spacecraft 
three-axis controllability, thus conditions a) and b) are not independent in the sense 
that the ability to produce a required torque implies that the CMG system is not in an 
undesirable configuration. 




To produce a desired torque requires the solution of the underdetermined system of 
sinultaneous linear equations given by: 

= I (3-6) 

The general solution to a non-homogeneous system of linear equations such as (3-6), 
can be formed from the solution to the homogeneous system, and any particular sol- 
ution, as was discussed in Chapter 2. When the rank of the Jacobian matrix is 3, infi- 
nitely many solutions to (3-6) exist. In this case, the particular solution is almost 
always obtained using the Moorc-Penrose pseudoinverse [2] , which is given by: 


ft P = j\jJ T ) 'r '3-7) 

lo illustrate the properties of (3-7), a derivation based on orthogonal projections is 
presented in the next section. To motivate this derivation the properties of the the 
Moore- Penrose pseudoinverse arc presented below: 

a) 6 P is orthogonal to ft H . Therefore, < 6 f , ft,, > = 0. 

b) The particular solution is the minimum norm solution to (3-6), as can be seen 
from the Pythagorean theorem: 

Ifif = | e, I s + |a „| 2 

Since the particular and homogeneous solutions are orthogonal to each other, 
the norm of the solution will be smallest when the homogeneous solution is 
zero. 
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3.4.1 Derivation Of The Moore-Penrose Pseudoinverse Using Orthogonal Projections 


From the fundamental theorem of linear algebra [9], the row space of any matrix 
is perpendicular to its nullspace. Since the torque producing solution lies in the row 
space of J , we can write the general solution to (3-6) in the form: 


d = d R , 0 V 

where 0 R = Torque producing solution ( J d R = t ) 

0 V = Homogeneous solution {Jd\ — L! ) 

The torque producing solution can now be written as a linear combination o( the row- 
space basis vectors. Since the Jacobian matrix is nonsingular, it has 3 linearly inde- 
pendent row vectors. The row space is spanned by these vectors (which become the 
columns of J r ). thus we can write the torque producing solution as: 


= y - J ' 2 


r ih 

where R, = i Jacobian row vector 


Substituting (3-8) in (3-6) we obtain 


J J r i = i 


from which we can solve for 2: 


2 


J J 


r \-i 


(3-9) 
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To obtain the final result for 0 R we substitute ( 3-9 , into (3-8) 


to get: 


- J T {jJ T ) 'r (3.10) 

This is the desired final result. By picking the particular solu.ton as (3-10). the proper- 

nes of the Moore-Penrose pseudoinverse are sattsfied. Since the pseudoinverse provides 

.he minimum 2 .„„rm solution, an alternative dertvat.on can he obtained using 
Lagrange multipliers to solve the following problem: 


min 

subject to JO = x 

with Hamiltonian H = ~ 0 T 0 + / T ( x - J i) ) 


fhis minimization will yield 0 


Qr, as defined in (3-10)'. 


I he homogeneous solution can be written 


null space basis vectors. 


as a linear combination 


of the Jacobian 


in = 


n—r(J) 

V 

l— 1 


'<</) V, 


(3-11) 


where 


'■,(') Time varying scalar weighting factor 

= dimensional Jacobian null space basis vector 
r (J) — Rank oj Jacobian 


The computation of the null space basts vectors 
cross-product approach as presented in Chapter 2. 


is carried out using the generalized 
The scalar weighting factor deter- 


t 






# 
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mines the magnitude and sign of the contribution of each null space basis vector to the 
homogeneous solution. These are the free design parameters, to be selected in a man- 
ner that the performance criteria for the Steering law are accomplished. 

Because d R is orthogonal to 0, v , any general solution to (3-6) can be written in 
terms of the Moore- Penrose pseudoinverse and any homogeneous solution. An alter- 
native approach for a Steering law utilizing linear programming is discussed in the next 
section. 

3.5 REDUNDANCY RESOLUTION VIA LINEAR PROGRAMMING 

Another way of addressing the singularity avoidance and steering problem is to 
assign gimbal rates via linear programming, as described in [10]. The instantaneous 
torque output of each gimbal is used to form a set of activity vectors that are used to 
satisfy spacecraft rate-change requests by solving for approximate gimbal displace- 
ments, or torque requests by solving for instantaneous gimbal rates. The linear pro- 
gram intrinsically incorporates upper bounds on the CMG selection that limit allowed 
gimbal displacements and rates while optimizing an objective function to encourage 
avoidance of singular configurations and gimbal stops. U nfortunately, this method like 
all available methods, cannot avoid all internal singularities due to the use of a gra- 
dient-based objective (to be discussed in Chapter 5). Linear programming has been 
applied to double gimbal CMGs, however, with considerable success. 

This approach can also account for hybrid control of spacecraft using both jets 
and CMGs. It is highly adaptable to hardware failures, variations in CMG system deli- 
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nition, and changes in vehicle mass properties. A major advantage of this approach is 
that performance' criteria can be explicitly and dynamically taken into account merely 
by altering the linear objective functions and imposed upper bounds. 


CHAPTER 4 


SINGULAR CONTROL MOMENT GYRO (CMG) CONFIGURA- 
TIONS 

* 

i 

4.1 DEFINITION OF SINGULARITY j 

i 

l 

Spacecraft attitude control systems utilizing single gimbal CVIGs must effectively 
address the singularity conditions inherent with this type of actuators. These conditions j 

prevail when the CMG system is in a configuration that precludes torque generation in j 

a certain direction, i.e. spacecraft three-axis controllability is lost. These conditions, if 
not properly addressed, severely limit the usable momentum capability of the CMG 
system. Not only must the singularities themselves be avoided; neighborhoods of sin- 
gular states represent regions of limited torque capability, thus require high gimbal 
rates to generate the requisite torque. Hardware limits on gimbal rates therefore entail 
that these neighborhoods also be considered in the control law design. 


The requirement of spacecraft three-axis controllability is expressed by the rank of 
the CMG system Jacobian matrix. If the rank of the Jacobian is less than 3, the CV1G 
system is unable to p r oduce torque along a direction u, referred to as the singular 
direction in t?. This is summarized below: 


Singular State: A singular state can be defined as a set of gimbal angles for which the 
CMG system is unable to produce torque along the singular direction u. This occurs 
whenever rank(J) < 3. the number of controlled axes. 


For 3-axis control the maximal rank of the Jacobian is 3 and the minimal rank is 2, 


because the gimbal axes, 6 arc not mounted coplanar. For example, if rank(J) = 2, 
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the resultant otput torque lies in a plane which is spanned by the columns of the Jaco- 
bian matrix. The singular direction u is then perpendicular to this plane. This condi- 


tion can be stated as: 


MOif'U = 0 (/ = 1,2 ,...,«) 


The gimbal angles corresponding to a singular configuration can be computed 
using (4-1) and the expression for the Jacobian columns with respect to the reference 
gimbal coordina-te frame (2-1). The i* column of the Jacobian matrix is: 


Jj = h [ cos dJi 0 - Sin 0 t hi 0 ] 


Combining (4-1) with (4-2) we obtain 


jj'U = cos 0,0; °.w) - sin dj (hj 0 »u) = o 


the solutions of which are the singular g.mbal angles. These angles are obtained from: 


Of = tan 


1 1 e iJi 


£, h, • u 


where Of = Singular gimbal angle ( 2 solutions ) 
£/ = ± 1 


The two solutions obtained from (4-4) correspond to the two extreme projections of 
the /'* angular momentum vector on the singular direction. These arc the maximum 
positive and maximum negative projections, therefore there corresponds two solutions 






* 

* •>' 

i 

4 

t 

j 

4 

4 
| 

5 

| 

for each singularity and momentum vector associated with maximum positive ( + ) and 
maximum negative (-) projections along the singular direction. Examples of the vari- 
ous sign patterns can be found in [11] . The singularity problem can thus be summa- ' 

rized for a n-CMG system: There exist 2” combinations of gimbal angles for which the 
CMG system cannot produce torque about any given direction in space [1] . 

t 

All singular states can be classified according to their location in the total CMG 

angular momentum envelope: { 

* 

a) Surface or Saturation Singularities 

b) Internal Singularities 

i) Elliptic or Unescapable 

ii) Hyperbolic 

4.2 SATURATION SINGULARITY j 

As the name suggests, a Saturation singularity corresponds to a configuration for 
which the CMG system has projected its maximum momentum capability along a cer- 
tain direction. A Saturation singularity can be defined as the set of gimbal angles for 
which the total momentum of the CMG system lies on the momentum envelope 
(implying that the momentum linkage tip has reached the momentum envelope). The 
mechanical analog to this type of a singularity is a completely stretched manipulator. 

Deeper insight about the Saturation singularity can be gained by examining the 
behaviour of the momentum linkage. The momentum envelope, which is generated by 
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motion of the maximally stretched linkage, is the set of radius vectors from zero 
momentum to the saturation surface. The direction of the maximal stretch is termed 
the saturation direction ', and the singular direction is given by the outward normal to 
the momentum envelope at the point of contact of the linkage tip. These directions are 
illustrated in Figure 4-1, which depicts the projection of the momentum envelope on 
the Z — X plane [12]. Since the linkage tip is restrained to move either on the envel- 
ope or inside, no motion is possible beyond the envelope in the outward normal direc- 
tion. Vlotion along the inward normal is also instantaneously not possible, since the 
Jacobian is still singular. To be more precise, the singular direction is an axis along 
which instantaneous C.Y1G output torque capability is entirely lost. Torque can only 
be generated along the tangent plane to the envelope, which has as its normal vector 
the singular direction at the point of the linkage tip contact. !n this case, the CY1G 
system is termed saturated with reference to the direction u , since the system has pro- 
jected its maximum available momentum in this direction. We can summarize the crite- 
ria for a Saturation singularity as: 



a) Rank(J) < 3 

b) All h • u > 0 (/ = 1 n) 

An example of this type of singularity for the Pyramid mounted 4-CMG system 
and the 3-link planar manipulator is shown in Figure 4-2. From the figure, we can see 
that all the gimbals have projected their maximum momentum capability along the sin- 
gular direction. From the manipulator example, it is intuitively clear that there can be 
no relative motion of the links which does not afTcct the enu-cfTcctor location. There is 



50 




MOMENTUM ENVELOPE 


SATURATION DIRECTION 


SINGULAR DIRECTION 

X*- * 


L \ 


\ MOMENTUM PROJECTIONS ON X-Z PLANE/ 

Figure 4-1. Saturation Singularity Projections For 4-SG CMG System 

no null motion possible for this type of singularity. A degenerate case where null 
motion would be possible can be imagined if the ground pivot allowed rotation about 
the singular direction, but this is excluded for this type of manipulator. The same com- 
ments apply to the CMG system; For a maximally projected CMG linkage, no null 
motion is possible (no degenerate case exists for the CMG system). 

From the above discussion, it can be seen that a Saturation singularity corresponds 
to the physical capabilities of the CMG system. Thus, the term "desaturation" refers to 
the process by which the resultant momentum vector is removed or retracted from the 
envelope or surface without net momentum transfer to the spacecraft. To accomplish 
this task, an external torque (such as jet firings or gravity gradient/aerodynamic tor- 
ques) is required to cancel the torque exerted on the spacecraft while desaturating the 
CMG system. Saturation states cannot be avoided by the Steering law alone; A 


€> 
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momentum management procedure such as [13], [14] must be used to command the 
spacecraft attitude such that the CMGs remain unsaturated. 


CMG SYSTEM 


z 



MECHANICAL ANALOG 
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Q > 0 


f = [o°.o-,o o ] 


Figure 4-2. Example Of Saturation Singularity 
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4.3 INTERNAL SINGULARITIES 

Any singular state for which the total angular momentum vector (or linkage) is not 
completely stretched is defined by default to be an Internal singularity. These states 
can be generated from the Saturation singularity by reversing one or more angular 
momentum vectors so that they point opposite to the singular direction. For a 
4-CMG system, these singularities can be grouped into two categories. One category- 
consists of an even number of positive and negative projections, and the other category 
is made up of an odd number of positive and negative projections. The mechanical 
analog to this situation is a manipulator with folded links. Some singularities can offer 
the possibility of escape through null motion, therefore it is useful to investigate the 
conditions under which singular configurations can be removed by null motion alone, 

and thus classify Internal singularities according to whether a null motion escape is 
possible. 


I he term escape" used in this context needs to be defined carefully. The term 
escape will be defined in the following manner: 

Escape By Null Motion: A singular CMG system can be reconfigured by null motion 
into a non-singular configuration, if one exists for the same total angular momentum. 

The implications of this statement are twofold. 

a) A non-singular configuration is reachable by null motion from the singular-co- 
nfiguration; i.c. the CMG system can be reconfigured in a continuous manner 


1 ® 


using null motion only. To state it succinctly, the two solution sets are not dis- 
joint with respect to null motion. 

b) The rank of the Jacobian can be affected (increased) by these null motion. The 

singularity measure (to be introduced later) is increased also (can be made non- 
zero). 

An immediate consequence of these statements is that Saturation singularities are not 
escapable. This will be established rigorously in the next section, when a test for the 
possibility of null motion near a singularity is presented. It should also be emphasized 
that the mere possibility of null motion at a singularity does not automatically imply 
that the singularity is escapable. An example of this was given in the degenerate Satu- 
ration singularity discussion for the manipulator. 

4.3. 1 Test For Possibility Of Null Motion Near A Singularity 

Valuable insist can be gained by investigating the conditions under which null 
mot.on is possible near a singularity. A method to examin.ne the behav iour of a CMC 
system using null mot.on near a singular state can be found in [1], A similar approach 
based on this method will now be presented. Let !?(d s ) denote a singular CMC, config- 
uration. [Expanding the total CMG angular momentum about about this singular con- 
figuration, d s , we obtain: 


m ~ ** = + + ".ox 










The first partial on the right hand side of (4-5) is jus, the i» column vector of the Jaco- 
bian. The expression for the second partial is given bv: 


6 ‘ = 6 ‘ B i x Jj=~ $ i hi h, 


dji 


A 


dd] ddi 


= - hi h l = - h t 


If we now take the inner product of ,4-5, with the singular direction. the fir,, term 
on the right hand s.de drops on, because the singular direction ,s orthogonal to the 
Jacobian columns, i.e. #?) . u = 0 . The resulting expression is: 


= S9f 

i=\ 

Recognizing .ha, the right hand stde of, 4-6, is a quadratic form, i, can be vvntten as: 


(4-6) 


w .[ A - A 5 ] = -- J -< 50 7 ><)0 


(4-7) 


where P = diag(h ? . u) j = jj n 


The diagonal matrix P will be refered 


to as the projection matrix, since its elements 
represent the projections of the singular angular 
direction. 


momentum vectors onto the sineular 


The governing equation for the null motton test is expressed by (4-7,. order lo 
examine the behaviour of (4-7| for null motion near a singularity, the varia 


ations in aim- 
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bal angles <>0, are defined to be null motion. For null motion, h = \f by definition, 
since null motion do not afTect the total angular momentum of the system. Therefore, 
(4-7) becomes (neglecting the constant): 

8d T P 88 = 0 (4.g) 

The null motion can be expressed as a iinear combination of the null-space basis vec- 
tors as in [15]. The gimbal angle variations can then be expressed in this basis as: 




= Yj = A "^ 


where / ( = Scalar weighting factor 

y, = Xull space basis vector ( n — dimensional ) 
r{j) = Rank of Jacobian matrix 

Substituting (4-9) in (4-8) , we obtain the desired final result: 


L QL = o 

where Q = X T P X 


(4-10) 


This quadratic form can now be used to test the possibility of null mot 
singularity. Two possibilities exist: 


ion near a 


a) Definite Q 
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b) Indefinite or Semi- Definite Q 


4.3. 1.1 Definite Q 


If ^ is definite, the quadratic form is definite, and in order to satisfy (4-10) we 
must have A = 0 . This implies that no null motion is possible at this singular config- 
uration, therefore no escape is possible from this singularity by null motion. Near a 
singularity of this type, the CMC system cannot be reconfigured by null motion into a 
non-singular configuration; the two configurations are disjoint solutions to the total 
system momentum. This result can be used to identify unescapable singularities. 


When P is definite, Q is also definite. This corresponds to the case of a Saturation 
singularity, for which all angular momenta have maximum positive projections on the 
singular direction. All the elements of the diagonal projection matrix are positive. 
This type of singularity was defined in [1] as Elliptic, because the quadratic in (4-7) has 
the form of an elliptic conic section, an ellipsoid. Using this notation for the case of 
definite Q, the singularity will be defined as Elliptic or unescapable. Eor Q to be defi- 
nite, it is not necccssary that all momenta have positive projections on the singular 
directions; i.e. P can be indefinite. Odd numbers of positive and negative projections 
usually result in a definite quadratic form. A case for an even number of projections 
has not been found for which the quadratic form is definite. 

4.3. 1.2 Indefinite Or Semi-Definite Q 


I he other possibility for (4-10) is to be either indefinite or scmi-dcfinitc. It is 
indefinite when the eigenvalues of Q are both positive and negative, and is positive 
(negative) scmidefinitc if Q has non-negative (non-positive) eigenvalues, i.e. has at least 
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one zero cgenvalue [2] . In this case, Z = 0 satisfies (4-W,. Th,s implies that „ ul | 
motion is possible at this singularity, therefore null motion may provide a possibility of 
escape. In order to definitely state that escape is possible, degenerate solu.tons must 
be excluded. Degenerate solutions are those for which rigid body rotation is possible 
which does not alfec, the total system momentum. The term rig.d body ,s used to indi- 
cate the fact that the the singular configuration remams undisturbed durmg these null 
motion. An example of this was given in “4.2 Saturation Singularity” for a manipula- 
•or. In that case, the rigid bod, is the stretched linkage which can rotate about the 
stretch axis. Simtlarly, i, may be possible that the momentum Imkagc could possess 
configurations for which rigid body rotations are possible. 


Th,s type of singularity was defined in [I] as Hyperbolic because the quadrat, c in 
(4-7) has the form ofa hyperbolic come sec, on. a hyperboloid. Using this no, at, on, a 
singularity for which 8 « e.ther semi-definite or indefinite will be defined as llyperbol- 


IC. 


Applying the above conclus.ons, the results of the null mot, on test can be used to 
class, fy the two possiblht.es which cx.st for an Internal singular, ty: 


a) Elliptic or Unescapable Singularity ( Q Definite ) 

b) Hyperbolic Singularity ( Q Indefinite or Semi-Definite ) 


It is evident that Hyperbolic singularifics offer the poss.b.lity of escape through null 
These cases must be exammed for degenerate solutions determme the poss,- 
bdi.y of escape. Example, of, he various singularities arc presented in the next sec, ion 
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OF INTERNAL SINGULARITIES 

, examples of the two different types of Internal singularitites are 
presented for the 4-Pyramid CMG system and the planar 3-link manipulator intro- 
duced in Chapter 2. All the relevant computations for the null motion test are pre- 
sented in each case. The choice of singular direction, for both systems is the spacecraft 

A 

.V-axis, i.e. u = X . For simplicity, h = l = 1 . 

4.4.1 Example Of Elliptic Or Unescapable Internal Singularity 

A particular example of an Internal Elliptic singularity is shown in f igure 4-3. The 
4-Pyramid CMG system will be discussed first. The configuration for this singularity is 
defined by the gimbal angles: 8 s = [ -90°, 0°, 90°, 0° . It is seen that there are an 

odd number of equal sign momentum projections along the singular direction u = .V. 
The sign pattern of these projections is -I- , — [] for this singularity. 

fhe row-echelon form of the Jacobian matrix evaluated at these gimbal angles is: 

10 1 2 efi 

J = 0 I 0 i 

0 0 0 o 

The linearly independent (but non-orthogonal) null-space basis vectors can be obtained 
from the row-echelon form. These two null-vectors can be constructed from the 
dependent columns of the Jacobian: 



i 

1 




To obtain the projection matrix, the inner product of each C\1G angular momen- 
tum with the singular direction is evaluated at these gimbal angles. The projection 
matrix for this case becomes: 

cP 0 0 () 

P = o -1 0 0 

0 0 efi 0 

0 o 0 1 

Carrying out the matrix multiplications in (4-10), the expression for the symmetric Q 
matrix is: 



t 
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An example of an unescapable singularity for the manipulator is shown in 
Figure 4-2. The singularity is defined by the joint angles: qs = [0°, 180°, 180° 

The sign pattern of the projections in the singular direction u = X becomes 

The row-echelon form of the Jacobian and the null-space basis are given by: 


r i -o.5 

-0.5 1 

A = 

' 0.5 

0.5 ' 

L o o 

o J 

1 

0 




. o 

1 


The projection and Q matrices are: 


P = 0 

0 


0 0 

-1 0 

-1 -1 


Q = 0.5 


["!-!] 


The upper-triangular form is: 


The pivots are -I. 0. Thus the quadratic form is negative semi-definite. 0 < 0. which 
suggests that this singularity is Hyperbolic and null motion is poss.ble. This is a degen- 
erate singularity however, because rigid body motion is possible by null motion, since 
the manipulator can be rotated as a rigid body about the grounded pivot without 

affecting the location of the tip. As a consequence, escape from this singularity is not 
possible by null motion. 



<*> 


4.4.2 Example Of Hyperbolic Internal Singularity 


An example of an Internal Hyperbolic singularity is shown in Figure 4-4. The sin- 
gular configuration for the CMC system is defined by the gimbal angles: 

~ = C 90 °’ ,80 °’ - 90 °.0° ] . The sign pattern of the projections for this singularity 
* s C ~ * + , — , 4- ] . 


The row-echelon form of the Jacobian and the non-orthogonal null-space basis are 
given by: 


1 0 1 —2c/? 

J - 0 10 _i 

0 0 0 o 


-1 2c/? 

0 1 

1 0 

0 1 


The projection and Q matrices become: 


-cp 0 

0 1 

0 0 
0 0 


0 0 
0 0 
- cp 0 
0 1 


Q = 2 


~cP cp 1 
C P 1 - 2c/? 3 


The upper triangular form of Q is: 


Q = 2 


-cp cP 2 


0 l - cp 2 


The pivots arc - cp, 1 - c p\ Since 0 < cp < I, then 1 - c/? 3 > 0 . and the 


quadratic form is indefinite. For this case null motion is possible, and the singularity 
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can also be escaped. Curren.ly, the degeneracy of the Hyperbolic singularity is 
resolved by simulation. This will be discussed in Chapter 5. 


For the manipulator the singular configuration is defined by the joint angles: 
q* = C0°, 180°, 0° ] . 


The row-echelon form of the Jacobian matrix and the null-space basis are: 


r i -o.5 

0.5 1 

.V = 

r 0.5 -0.5 1 

L o o 

0 J 

1 

° 




. o 
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The projection and Q matrices become: 


P = 


' 2 

0 

0 

q = o.5 r i 


0 

-1 

0 

-■ 1 

. 0 

0 

1 

L -i 

3 J 


The upper-triangular form is: 


e - a5 [~« 1 ] 


The pivots are -1. 4, therefore the quadratic form ,s indefinite. In this case null motion 
is possible as well as escape from the singularity. 


4.5 EXAMPLE OF SATURATION SINGULARITY 


In this section a similar analysis is carried out for the Saturation singularity exa 


exam- 
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Figure 4-4. Example Of Hyperbolic Internal Singularity 
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pie used in Figure 4-2. The singular configuration for the CMG system is defined by 
the gimbal angles: 9 s = [ —90°, 180°, 90°, 0° ] 


The row-echelon form of the Jacobian and its corresponding null-space basis is 
given by: 



J = 


1 

0 

1 

2 cp ' 


-1 

-2 cp " 

0 

1 

0 

-1 

tV = 

0 

1 

0 

0 

0 

0 


1 

0 






0 
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The Q matrix and its upper-triangular form 

Q = 2 


are: 


cp c($ 2 
cp 2 2cP 3 + 1 


Q = 


cP cp 2 

o Cp 3 + I 


The pivots are c p and c/F + 1. Both are positive, thus Q > 0, i.e. is positive definite. 
This suggests that the singularity is of Elliptic type and is uncscapablc by null motion. 

No null motton whatsoever is possible for this case, as earlier observed to be a proper- 
ty of the Saturation singularity. 


In the case ol the manipulator, the singularity is defined by the joint angles: 
= C ] The row -ochclon form of the Jacobian and its null-space basis 


are: 


r i o.5 

0.5 1 

-0.5 

-0.5 

L 0 0 
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The pivots are 3, 8/3. Both pivots are positive, and Q > 0. The singularity is therefore 
Elliptic, and no null motion is possible. 


4.6 MEASURE OF SINGULARITY 

We have seen that the rank of the Jacobian matrix is an indicator of the singulari- 
ty of the CMG system. This information can be used to define an index, the singularitv 
measure m, which shows how close the CMG system is to being singular. In the litera- 
ture, m? is also refered to as the CMG "gain" [15]. The derivation of the singularity 
measure presented here employs the Singular Value Decomposition (SVD) of the Jaco- 
bian matrix, which is given by: 

J(d)=UZV T (4-11) 


where V is a 3x3 orthonormal matrix 
V is a n x n orthonormal matrix 
<f\ 0 0 


v _ 


0 0 [ 0 ] 


0 0 <r 3 

o l * () singular values 


l or a matrix to be nonsingular, all of its singular values must be greater than zero 
[2], therefore the product of the singular values can be used as a singularity measure. 
T his is given by: 






Since, m is a measure of spacecraft 3-axis controllability, the CMG system approaches 
a singular state as m — » 0. The parameter m 2 has been used as an objective function for 
a singularity-avoidance Steering law using single-gimbal CMGs [15], and m has been 
usvd for double-gimbal CMG Steering laws [16], Tor redundant manipulators, this 
measure was called manipulability [17], In the next section, a convenient formula is 
presented to evaluate the singularity measure. 


4.6.1 Formula For The Singularity Measure 


The numerical computation of the singularity measure can become difficult, even 
for a CMG system with only one degree of redundancy. The computational burden 
may be reduced by using the Binet-Cauchv r c..nu [8] : 
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m = 


£*? (f) = 
/= 1 


N(N — 1)(.V— 2) 
3! 


N > 3 


(4-13) 


H 


where V/ ; = ^ .V j distinct Jacobian minors of order 3 
For the Pyramid mounted 4-C.MG system, the measure can be written as: 


m — \ A/, 4- .V/i + .V /3 4- .V /4 


(4-14) 





The evaluation of the singularity measure is much simpler by this formula, since 
the order 3 minors of the Jacobian matrix are dimensioned smaller as well as having 
simple entries than the square matrix formed from ( J J T ). Since this formula expresses 
the measure in terms of all distinct minors of order 3 which are extractable from the 
Jacobian, we can see from (4-14) that individual minors can be zero, (implying loss of 
three-axis controllability for the corresponding sub-system of 3 C\1 (is) while the sys- 
tem as a whole remains non-singular. 

A new measure of distance from singular points was recently proposed for redun- 
dant manipulators [18], This new measure is defined in terms of the product of non- 
singular Jacobian minors. Since the minors represent the relative folding of all 
sub-groups of links, this measure reflects the number of relatively unfolded (non-coli- 
ncar) groups of links remaining 1.1 the manipulator system. This approach can analo- 
gously be used in CMC Steering la*vs. However, since keeping the product of minors 
non-zero precludes the switching of solutions (or linkage configuration) it is felt that 
this approach is not appropriate for CMG Steering laws. 
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This switching of solutions is determined by the singular minors, that is gimbal 
angles for which K = 0 , define the boundary between one form of join, configuration 
and another form. In nonredundant systems, this boundary is defined by det(.f) = 0. 
This fact can be most easily understood by refenng to the planar Mink manipulator 
(introduced in Chapter 2) in Figure 4-5, which shows the transition from one joint 
configuration or closure (A) to another closure (C) through the switch configuration 
(B) while the total system is nonsingular through the switch. It is seen that the switch 
boundary occurs when links #2 and « are col, near, which implies that 
= lifrl = 0 at the boundary, while the other two minors are nonzero. This 
switching is undesirable in manipulators because i, leads to repealability problems. On 
the other hand, in CMC systems this switching is desirable for singularity avoidance. 





Figure 4-5, Transition Between Two Joint Closures 


Via Singular Minor 
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Armed with this definition, the null- vector of the Jacobian can be better under- 
stood; this understanding will be vital in the design of the Steering law. The fundamen- 
tal attributes of the null-vector, its magnitude and direction, for non-singular systems 
of single-degree redundancy can be summarized as follows: 

Magnitude Of Null-Vector The magnitude of the null-space basis vector is identical to 
the singularity measure, m, thus is directly related to the nearness of a singularity. 


Direction Of Null-Vector: The direction of null motion is defined by the non-zero dis- 
tinct minors of order 3 extractable from the Jacobian matrix. The availability of null 
motion from each CVIG is also determined by these non-zero minors. 


The above statements dictate that the amount of null motion available from each gim- 
bal is governed by both the singularity measure and its corresponding minor. On the 


other hand, the possibility of extracting null motion from each CMG is determined 


only by the value of the corresponding minor. 



i 
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CHAPTER 5 


KINEMATIC REDUNDANCY RESOLUTION METHODS 


5.1 GENERAL SOLUTION METHODS 


In this chapter, various torque-input Steering laws will be reviewed, and their per- 
formance evaluated. Alternative methods of singularity avoidance will also be pro- 
posed, and their behaviour likewise examined. The results of Chapter 4 will be used 
extensively to evaluate and understand the performance of the difTcrent Steering laws. 
It will be shown that existing singularity avoidance methods do not avoid Elliptic type 
internal singularities. 

Kinematic methods of redundancy resolution require the solution of an undcrdetcr- 
mined system of linear simultaneous equations (the torque equation) involving the 
instantaneous Jacobian matrix of the CMC system. 

M)d = i ,5-h 


i\ 
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These methods are refered to as local, because they yield gimbal rate solutions to the 

instantaneous torque request. Redundancy is also resolved instantaneously, based on 

some criteria that hopefully steer the gimbal angles away from internal singular config- « 

urations while simultaneously satisfying the torque request, r. Local methods have the 

advantage that real-time implementation is readily feasible. 1 


The general solution to (3-6) was shown in Chapter 3 to be formed from the 
Moore- Penrose pscudoinversc and any homogeneous solution. This form can be fur- 
ther classified into the following three categories: 


< 
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a) Pseudoinverse ( Moore-Penrose ) Method 



b) Weighted Pseudoinverse 

d = IV~ ] J T (J IV~ 1 J T )~' t (5-3) 

c) Pseudoinverse With Null Motion 

i) Projection Matrix 

6 = J T (JJ T )~' t + y [ i - J T (JJ T )~ ] J ] d (5-4) 

ii) Null Vector 

n — r(J) 

6 = J T (J J T )~' i + Y, (5-5) 

I 

To illustrate the properties of the various methods, computer simulations using the 
Pyramid mounted 4-CMG system will be used. 

5.1.1 Simulation Parameters To Exercise Steering Laws 

To illustrate the singularity avoidance properties of the various solution methods, a 

A 

constant torque request along the spacecraft ,V-axis will be used. This direction is cho- 
sen because it will force the CMG system through the Elliptic internal singularity 



which was analyzed in Chapter 4. Since the Elliptic singularity represents the worst 
type of singular configuration, it can be used as a measure of the singularity avoidance 
capability of the particular method used in the Steering law. Also, the torque request 
is aligned with the singular direction, which represents the worst possible combination. 
It should be noted that non-degenerate Hyperbolic internal singularities can be avoided 
by any of the above methods; this will be shown by computer simulation. 


During the course of the computer simulations, it was found that the method used 
to calculate the pseudoinverse could affect the gimbal angle trajectories. The first meth- 
od which was used, numerically evaluated the pseudoinverse using symbolic expressions 
for the adjoint of the square matrix (J J and its determinant. This square matrix is 
ideally symmetric, however, during computation it was observed that there were slight 
discrepancies between the off-diagonal terms due to truncation errors. For this reason, 
the dyadic form of ( J J r ) was used instead (as in [1]) to obtain a closed form solution 
for the torque producing gimbal rates. This solution is given by: 


{ v ^i I h jj I I + M 2 I h Ja I I + 'A | jj Ji 1 I f 


ol = 


7 I - v/ . \jj h 1 1 - v/ 2 1 y, M t | + ,i/ 4 1 /, j, x | } 

“V { I h Jj 1 I - | j\ U I I - Mi | h Ji T I I 

7 { -^2 I Jj Jj I I + M 3 \ yj j 3 r | + .V/ 4 | j 2 j 3 r | !■ 


where M ( = Jacobian minors of order 3 

Of = Torque producing gimbal rales 


I his approach was found to yield more accurate results than the ssmbohe imerse. 
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The CMG dynamics were integrated at a simulation interval of 0.01 sec, unless 
otherwise stated. The gimbal rates were integrated using the routine DVERK from the 
IMSL library, which performs a fifth-sixth order Runge-Kutta numeric integration. A 
tolerance value of 0.0001 was used. Programs were written in double precision Fortran 
77. The torque request and angular momentum magnitudes were set equal to unity (i.e. 

h = *’ III = 0. and no rate limits were enforced. The applied torque request vec- 
tor was: 



The initial gimbal angles for all simulations were each set to 0. 

5.2 PSEUDOINVERSE ( MOORE-PENROSE ) METHOD 

1 he properties of this method were discussed in detail in Chapter 3, thus will not 
be repeated here. It has been shown [19] that this method can generate gimbal angle 
trajectories that pass arbitrarily close to singular points in gimbal angle space, therefore 
this method cannot be used by itself to avoid singular states. 

f rom the simulation results given in Figure 5-1 this fact can be easily seen. The 
singularity measure m ( SQRT( DET(JJT)) ) nears zero as the .V component angular 
momentum ( HX) approaches 1.15, indicating that the CMG system is singular. The 
singularity measure is non-zero as //, passes 0.85, indicating that the Hyperbolic singu- 
laritv analv/ed in Chpater 4 is avoided. This is the method by which the degeneracy of 
the Hyperbolic singularity is currently determined. The inner product of the torque 




• x,;: .. . 



solution ( i.e. d p ) with the gradient of the singularity measure ( GRA D. TORKSOL ) is 
also shown. Because the projection becomes negative, it is seen that the torque solution 
decreases the singularity measure as the singularity is approached. From the gimbal 
angle plots it is seen that gimbals #2 and #4 hardly move (the gimbal positions are 
shown with respect to the mounting configuration at H x = 0, and H x = 1.15 for easy 
visualization in Figure 5-2). It is seen from this figure that gimbal #2 always has mini- 
mum projection in the torque direction, while the other gimbals eventually reach maxi- 
mum projection in this direction. In essence gimbal U2 is "hung-up" in an anti-parallel 
orientation; it has no projection along the requested torque direction, hence is not 
used. 1 his serves to illustrate the general property of the pseudoinverse which tends 
not to move inefficiently oriented gimbals, and leave the system in a singular configura- 
tion well below the total momentum capacity (II X will reach saturation at approximate- 
ly 3.2 units). 


It may still be possible, however, to pass through the singularity bv switching to 
the rank 2 Moore-Penrose pseudoinverse algorithm described in [1] to maintain 2-axis 
control while the system is singular. As long as the singular direction does not lie 
along the desired torque direction, it is intuitively clear that the torque component in 
the plane spanned by the singular columns of the Jacobian can be generated. U nfortu- 
nately, this approach breaks down when the singular direction is colinear with the tor- 
que direction. This is easily seen from the formulation of the rank 2 pseudoinverse: 
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uhere 6 k — Torque producing gimbal rates 

- = Singular direction ( normal to plane spanned byjf ) 
Ji Singular Jacobian column vectors 


“ SKn ‘ hat ' r “ and 1 arc colinear - the s <*° n d determinant in the numerator is zero 
thus no torque is possible in the requested direction. For the Elliptic singularity a 

’ " 5 ' ' WS 15 MaC,ly ,he ca!e ' Ihe direction and the torque direction ur< 

identical, therefore this approach can no, always be used produce torque in the 
desired direction. 


5.3 WEIGHTED PSEUDOINVERSE 


The pseudoinverse may also be weighted to provide addittonal mechanisms bv 

which desired performance characteristics are achieved. This is accomplished by sole 
ing: 


nun 4pi T lT6 

subject to J i) = T 
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The weighting matrix IV must be positive definite. It is seen that the .Moore- Penrose 
(M-P) method is obtained by setting the weighting equal to the identity matrix l. 

The properties of this method are essentially the same as those of the M-P method 
as long as W = k\ For this case, the particular solution d P is orthogonal to the 
homogeneous solution d H . Otherwise, this property is not preserved, and this new sol- 
ution can be expressed as a combination of the M-P inverse and a homogeneous term. 
Assigning different values to the diagonal elements of W causes the participation of a 
particular gimbal with lower weighting to be favored more heavily in the solution; une- 
qual weighting of gimbal rates thus enforces high-authority low-authority partitioning 
of gimbal activity. This method may be used to reflect the energetics of a system 
(thereby minimizing energy), which would make it a dynamic rather than a kinematic 
method. An example of this would be using the inertia matrix of a manipulator as the 
weighting matrix in order to minimize system kinetic energy. This approach has been 
used . 1 , robotic applications, however it did not offer any improvement over the M-P 
inverse as far as singularity avoidance is concerned [20], 

from the previous pseudoinverse simulation results, it was noted that gimbal *2 
was essentially not moved. To encourage the motion of gimbal #2, a time varying 
diagonal weighting matrix was attempted. The intent was to reduce the penalty of inef- 
ficiently placed gimbals, thereby hopefully encouraging their movement. Correspond- 
ingly, any maximally projected gimbals were weighted with a higher cost to attenuate 
their participation. The diagonal entries of the weighting matrix thus become: 

w ‘ = w o + Q { | hf *1 | +- hf • rj / = 1 4 


< 
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where w 0 = Initial weighting 
C 0 = Multiplier 


The results of this approach are shown in Figure 5-3 The parameters that were used 
are w a ~ C 0 = 2 . The effect of the weighting matrix on the determinant of the 
square matrix J If 'J T ( SQJ DET), is seen not to prevent it from becoming singular. 
It is seen that the singularity at H x = 1.15 was still not avoided. From the weighting 
plots it is seen (as expected) that gimbal #2 always has the smallest cost, while the cost 
on gimbals #1 and continuously increased as they approached maximum projection 
on the torque direction. Comparing the gimbal angle plots of this approach with those 
of the M-P inverse, it seen that they are essentially identical. Although this method 
may hold promise in re-partitioning the use of different gimbals if off-diagonal terms 
were used in the weighting matrix, it has been shown to be ineffective in avoiding sin- 
gular states. Since this solution can be written in terms of the M-P inverse and an 
appropriately chosen homogeneous solution, it will not be pursued further. 

5.4 PSEUDOINVERSE WITH NULL MOTION 


We have seen that the pseudoinverse solution by itself docs not provide any singu- 
larity avoidance for Elliptic singularities. Since the homogeneous solution has no pro- 
jection on the row space of (3-6), i.e. produces no torque, it can be used to shape the 
complete solution and hopefully provide a means of singularity avoidance. The steer- 
ing problem then reduces to picking a vector in tne null-space of the Jacobian such 
that all internal singularities are avoided. The addition of null motion thus is to steer 
the gimbal angle trajectory to an alternative non-singular configuration correspondine 
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Figure 5-3. Simulation Results For Weighted-Pseudoinverse (Part 1 of 2) 



Figure 5-3. Gimbal Angles For Weighted-Pseudoinverse (Part 2 of 2) 
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For a singularity avoidance control law, all that remains is to pick the projection 
vector y J as in (5-4). In [19], it is shown that arbitrary girnbai angle trajectories 
which do not pass through a singular configuration may be generated using this meth- 
od by an appropriate choice of y d . This result requires that one choose a priori a sin- 
gularity free gimbal angle trajectory, and also select a projection vector that can 
recover or generate this trajectory. Normally, such a trajectory is not known before- 
hand; the generation of such a trajectory becomes the design objective. 

I he usual approach to singularity avoidance is to choose this projection vector 
such that a scalar performance index (such as the singularity measure), is optimized . 
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One way of accomplishing this is to maximize a scalar performance criterion p (0) bv 
choosing d as in [16]: 


d T = 


These types of procedures arc usually refered to as gradient methods. Since, p = d T 0. 
we use (5-4) to obtain: 


P = d r j\j J r ) -(- yd r [ 1 - J T (J J T ) ] j]d (5-7) 

I he second term in the right-hand side is non-negative because the projection matrix is 
positive scmidcfinitc [2], and contributes to an increase in the value of p. One way of 
choosing the scalar y is to maximize p (u = 0) subject to upper bounds on gimbal rates 
[16]. 1 he singularity measure, m was chosen as the performance index. It should be 

noted, however, that the singularity measure is not a monotonic function of the gimbal 
angles, thus instantaneously maximizing this function can lead to local extrema of the 
measure. It is shown in [15] that this method does not avoid singular states because 
the system is controlled to stay at the local maximum, and there exist trajectories of 
local maxima which nearly extend to singular points. Another way of expressing this is 
that the right hand side of (5-7) can be negative and may dominate p . thus resulting in 
a net decrease in the value ol p. I his phenomenon will be examined f urther in the next 
section. 


It is also mentioned in [II] (without any particular references » that gradient meth- 
ods using a performance index 
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have been tried unsuccessfully by several authors. It was suggested that the reason for 
this was that the determinant was not sufficiently sensitive to allow appropriate null 
motion be added in time to avoid close encounters with internal singularities. 

5.4. 1.1 Indirect Avoidance Control Law 

Another way of choosing the projection vector can also be found in [11] Ihis 
method, called the indirect avoidance law. relies on the observation that internal singu- 
larities can be avoided in most cases by merely steering towards the Saturation singu- 
larity associated with the instantaneous torque request. This method was succcsslull in 
avoiding internal singularities for a 6- Pyramid CVIG system. Since we have seen in our 
simulations that gimbal #2 was persistently hanging-up' antiparallel to the torque 
request for the VI -P inverse, this method seems to provide a means of encouraging this 
gimbal to move. The projection vector for this approach is defined is: 


d = A 6 = 8 wt - 8 



where 8 s , at = 


0 0 A 

1 Ji *« 


unir( t ) 

/* A0 ) 
unit( A 8 ) 

unit{ 6 P ) 
Projection matrix 


The indirect av oidance law was implemented in simulations of the 4-CV1G system with- 
out limiting the amount of null motion. The projection matrix was numerically calcu- 
lated using the symbolic adjoint of (J J T ). The simulation interval was 0.005 sec., with 
a final time of 1.18 sec. The results of the simulation are shown in Figure 5-4. It is 
seen that the Flliptic singularity is again not avoided since m still approaches zero at 
H x =1.1?. I he projection of the null vector, on the gradient is seen to go to zero 
near the singularity, thereby rendering any null motion ineffective in avoiding it. From 
the gimbal angle plots, it is observed that both gimbals »2 and nA move slightly, but 
not sufficiently to "un-lock" gimbal n2. 


5.4.2 Null Vector 


The Jacobian null-space basis vectors can also be used to form the null-vector. 
With this approach, only the scalar weighting factors remain to be determined. It 
should be noted that as the redundancy of the system increases, the dimension of the 
null-space also increases, which complicates the choice of these factors. For the case of 
four CVIGs and a nonsingular Jacobian matrix, the null-space dimension is one. thus 
null motion is restricted to a line. All that remains in this case is to choose the maeni- 
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tude and direction in which null motion is applied by using a single scale factor. The 
homogeneous solution can then be written as: 


0^ = a v 


One method of choosing the scale factor for a 4-Pyramid CY1G system is given in 
[lo]. This approach, called the maximum gam method, involves steering the null 
motion towards the point of maximum gain. This approach is global in the sense 
that the direction of null motion is oriented towards the point of global maximum gain 
in gimbal angle space, as obtained from a look-up table which is generated by off-line 
calculation and reduced to a small size by taking advantage of the symmetry of this 
particular configuration. This method also requires the location of all Elliptic type 
internal singularities to be determined in order that gimbai angle trajectories always 

avoid the neighborhoods of these singularities. This is accomplished by modifying the 
gimbal rates. 

The null vector strategy was applied in two different singularity avoidance laws. 
Both of these methods exploit the relationship derived in Chapter 4 between the null- 
space of the Jacobian and the singularity measure (or gain). These methods are: 


a) Gradient Method 

b) Inverse Gain Method 
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5.4.2. 1 Gradient Method 

The singularity measure m, was chosen as the performance index to be maximized. 
Using (5-5), the time rate of change of the performance index becomes: 

P ~ m • J T (J J T ) ‘ 1 + /. m . v (5-8) 

The sign of / is determined from the second term of (5-8). The gradient of the singular- 
ity measure was computed symbolically using M ACS Y. VI A (Vlacsyma Manual). 

To complete the control law design, an appropriate weighting factor / must be 
chosen. To do this, we must define the relevant parameters that may be advantageous 
to use in computing /. . Some useful parameters are: 

• m • We know / has to be at least proportional to to cancel the magnitude 
of the null-vector. Otherwise, the efTectivcness of /. will be reduced as the sys- 
tem approaches a singularity. 

• Power of singularity measure. The amount of null motion is related to distance 

from singularity. F or example, we could set / = — . This is the usual 

nr 

approach in other gradient methods. 

• •dp . Ihe amount of null motion is made proportional to the projection of 
the torque solution on the gradient of the performance index. It was observed 
earlier that this term can become negative, and thus reduce the value of p. By 
making the amount of null motion proportional to this term, this effect can 
potentially be taken into account and cancelled; for example. / could be made 




proportional to this term whenever it is negative. This scaling has not been uti- 
lized in other gradient methods. 

Vfl m • v . The amount of null motion is made proportional to the projection of 
the null-vector on the gradient of the performance index. This term expresses 
the possibility of affecting the index through null motion; if this term is small, 
the effectiveness of null motion is reduced, regardless of how it is determined. 


Taking into account all of the above criteria, the gradient method is formulated 
using a weighting factor that includes a a contribution from each parameter: 


V d m»v V d m*J T (JJ T ) ' i 


This approach is somewhat unique; of the gradient methods published in the literature 
[11], [15], all lack at least one of the four criteria mentioned above. 


Simulation results for this method are shown in figure 5-5. It is seen that the 
Elliptic singularity is still not avoided. The reason becomes evident if we look at the 
plots of the null-constant A ( SILL COS’S TXT ) , and the gradient projection on the 
null-vector ( GRAD. XU l.LVEC ). It is seen that the null-constant remains essentially 
zero up to the singularity. This is because the null-vector has very small or no projec- 
tion on the gradient at this period, thus no null motion was added. This simulation 
then is identical to using the Vl-P inverse by itself. Looking at the gimhal angle plots, 
wc see that gimbal »2 does not move, just as in the M-P inverse method. 
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The Moore-Pcnrose pscudoinverse is actually seen in this case to directly generate 
a gimbal angle trajectory of locally extreme m when commanding momentum to 
increase from zero along the X-axis (as shown in this example). This illustrates a gener- 
al defect of locally-optimal procedures which was mentioned previously; they tend to 
lock into trajectories of locally maximum gain which can actually lead into singular 
configurations. 


To overcome this shortcoming, another form of the gradient was tried, where the 
null-on-gradient projection was replaced by its sign. This is given by: 


k 


sign( V ^ m • y ) m • J T ( J J r ) 1 t 

2 

m 


(5-10) 



Simulation results for this approach are shown in Figure 5-6. It is seen that the singu- 
laritv is still not avoided. At the end of the simulation, the system is actually trapped in 
a near-singular configuration about the Elliptic singularity; it does not attain the exact 
singular configuration, as seen from the very small (but still Unite) value oi m. I he 
null-constant in this case is almost always non-zero and the null projection onto the 
gradient also becomes substantially non-zero, indicating that a different gimbal angle 
trajectory was generated here than the previous gradient method. In this case, the null 
motion (with magnitude now governed by the torque projection and singularity meas- 
ure) is added increasingly to the solution as the torque request pushes the system 
toward the singular state. Looking at the gimbal angle trajectories, it is seen that gim- 
bal n2 moves about 15° during the period when the null-projection is non-zero; howev- 
er this is not sufficient to avoid the singular state, and it is pulled back again again by 
the torque request. The gimbal angle plots for this example also illustrate how gimbal 


93 





4 


#4 has to correspondingly move in order to balance off-axis torques and "unlock gim- 
bal #2. 

5.4.1.2 Inverse Gain Method 

The previous examples indicated that dynamically manipulating the direction of 
null motion to instantaneously maximize controllability has been ineffective m avoiding 
singularities. This is due to the tendency of tangent-based methods to lock onto locally 
optimal gimbal angle trajectories that can lead toward singularities, as stated earlier. 
Based on this observation, a non-directional approach to singularity avoidance was 
tried, where the direction of added null motion was not specified, null motion was 
introduced in whatever direction the positive null-vector pointed; no sign factor was 
imposed. This was accomplished by choosing the weighting factor to include only a 
contribution inversely proportional to the sixth power of the singularity measure: 


1 



The reason for this choice is detailed in the following argument. It was shown in 
Chapter 4 that the null-vector, v can be written as: 


vvnere v is the unit vector in the direction of the null-vector. As discussed for the gradi- 
ent method, the magnitude of the null vector is cancelled by dividing it with m ■ null 
motion is thus added in the positive null direction, and the amount is proportional to 
_L . Although this approach has the advantage that it does not constrain null motion 

ftt 5 

to always increase the singularity measure (this can avoid local optimum lockup, as 





Figure 5-6. Simulation Results For Second Gradient Method (Part 1 of 2) 



Figure 5-6. Gimbal Angles For Second Gradient Method (Part 2 of 2) 
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encountered in the gradient method), this approach has two potential shortcomings. 
These are: 

a) null motion is added without regard to whether the performance index can be 
instantaneously affected by null motion. The indicator for this situation is: 

V 0 m • v — 0 

Even though null motion may not instantaneously increase the singularity mea- 
sure (as dictated by the above situation), null rates of arbitrary magnitude may 
still be calculated and added to the solution. 

b) Since the direction of null motion is not prescribed, it may actually decrease the 
magnitude of the singularity measure; thus inadvertantly steering towards a sin- 
gularity. 

From simulations using different exponents on m , it was noticed that increasing the 
exponent in the control law tended to increase the minimum value of m encountered 
during the simulation, thus reducing peak torque producing gimbal rates. This can be 
explained by the fact that increasing the exponent "flattens out" the m trajectory when 
m < 1 . The effect is to anticipate the singularity earlier than with the control laws 
using smaller exponents; the net amount of null motion is thus also greater and begins 
to be introdu'tv at an earlier time. 

mulation results applying the inverse gain method arc shown in Figures 5-7 
through 5-9. The magnitude of the null-constant was limited to 15. Looking at the 
plots of //, and m in Figure 5-7, this method is evidently seen to avoid the singularity. 
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Figure 5-8. Torque Producing Gimbal Rates For Inverse Gain Method 
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Figure 5-8. Null Gimbal Rates For Inverse Gain Method (Rad/Sec) (Part 2 of 2) 
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Figure 5-9. Jacobian Minors For Inverse Gain Method 

The measure m is seen to dip somewhat as the singularity is approached, but definitely 
remains non-zero; H x is seen to continuously increase until the end of the simulation. 
The reason for singularity avoidance may indeed be that this method does not con- 
strain null motion to e.lways increase the singularity measure, 'hereby allowing the gim- 
bal angle trajectory to depart from local m-extrema, as seen from the non-zero values 
of the null projection encountered during the simulation. The efTect of the torque and 
null projections on the singularity measure is clearly seen in the corresponding plots; 
for t < 0.6 sec . , the torque solution increases the system gain, whereas the null projec- 
tion decreases it. This is clearly evident in the slight dip in the plot of singularity meas- 
ure over this time period. It is also seen that the null projection is very small near the 
singularity, and actually remains at zero near the end of the run (after about 2.4 sec.), 
when m has reached its maximum. A physical interpretation of this maximum m, in 
terms of the mechanical analog, suggests that the linkage may not be instantaneously 




reconfigured by null motion to a locally larger value of m; this determines the local 
extrema of the singularity measure (in the absence of a torque request), hence yields a 
zero gradient projection on the null- vector From the gimbal angle plots, it is seen that 
gimbal #2 is eventually rotated completely towards the the torque direction. Gimbal #4 
also moves to compensate for the off-axis torque errors introduced by the motion of 
gimbal #2 while it is being reconfigured from the "hung-up" negative projection orien- 
tation. 

In Figure 5-8, both the torque and non-torque producing gimbal rates arc shown. 
Large spikes are evident in both rates near the singularity. The largest magnitude of the 
applied null motion occurs at these spikes, where the null-projection is very small, thus 
rendering these motions ineffective in affecting the singularity measure. These large 
null-rates are due to the correspondingly large value of the null constant and small (but 
non-zero) valued minors that generate these motions. From the minor plots presented 
in Fieure 5-9, it is clearly seen that the singularity is avoided, since only minors and 
fe4 approach zero near I — 1.15 sec. Due to the large gimbal rates, this method cannot 
be considered a viable candidate for a Steering law. 

Because of the substantial null motion projection onto the m-gradicnt seen in Fig- 
ure 5-7, it is seen that the gimbal angle trajectory generated by this approach is not 
locally m-extreme. In addition, as noted above, this method added most of the null 
motion when the system was already nearly singular. In order to properly avoid the 
singular state, it would have probably been desirable to add null motion earlier in the 
trajectory, when m > 1 and the system was far-removed from problematic orien- 
tations. A second form of the inverse gain was thus formulated to accomplish this 
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strategy. The weighting factor is now chosen to also provide substantial null motion at 
high-m configurations: 


X = 


m if m > 1 

— if m < 1 
6 J 


(5-11) 


Simulation results using this "second inverse gain method" are shown in Figures 
5-10 through 5-12. The magnitude of the null-constant was limited to / m » = 5. From 
Figure 5-10. it is seen that this method is able to avoid the singularity. Comparing 
Figure 5-10 to Figure 5-7 , it is seen that the singularity measure has a larger magni- 
tude throughout the simulation for this updated method, implying a wider margin of 
singularity avoidance, hence smaller torque producing gimbal rates. The null projection 
appears very different for this method, which indicates that a different gimbal trajectory 
was generated. This is evident by looking at the corresponding gimbal angle plots, 
where it is obvious that gimbals Ul and #3 followed markedly different trajectories than 
encountered in the previous test (Figure 5-7). Because the singularity was better 
avoided, gimbal H2 is seen to have a much smoother trajectory. 


Both the torque and non-torque producing gimbal rates are shown in Figure 5-11. 
Comparing these plots with those in Figure 5-8. it is clearly evident that the gimbal 
rates generated by the second form are much smaller than those from the first form. 
Most importantly, no spikes arc apparent in the gimbal rates calculated using the sec- 
ond method. Looking at the null rates, it is seen that they no longer peak at large val- 
ues near the singularity. These rates arc less than half as large as the corresponding 
null rates calculated by the first form. From the minor plots presented in Figure 5-12. 
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Figure 5-10. Simulation Results For Second Inverse Gain Method (Part 1 of 2) 





Figure 5-10. Gimbal Angles For Second Inverse Gain Method (Part 2 of 2) 










Figure 5-12. Jacobian Minors For Second Inverse Gain Method 


it seen that only minor #2 is zero at t = 1.15 sec. Comparing this figure to Figure 5-9, 
the differences in the two plots are clearly seen. It is readily noted that two minors 
were zero near the sigularity for the first form, whereas only one minor was zero for 
the second form, again implying a much wider avoidance of the singularity. 

5.4.3 Non-Constant Torque Request With Second Inverse Gain Method 
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To illustrate the adverse property of the inverse gain method (i.e. the arbitrary 
direction of null motion may actually steer the system toward a singularity), a non-con- 
stant torque request was used. The torque trajectory was defined such that the 
momentum trajectory shown in Figure 5-13 was followed with unit torque magnitude. 
!n terms of the mechanical analog, the end efTector moved along the prescribed path 
with unit velocity. 






I 




Figure 5-13. Momentum Trajectory For Non-Constant Torque Simulation 

To simulate this maneuver, the torque request was defined in the following man- 
ner: 

' 0.7071 

t = 0.7071 for t < 0.83 sec. 

0 

-0.7071 

1 = 0.7071 for 0.83 sec. < t < 1.626 sec. 

L 0 

Simulation results for this maneuver are shown in Figures 5-14 through 5-16. The 
magnitude of the null-constant was limited to 3. From Figure 5-14, it is clearly seen 
that the system becomes singular just before the torque direction is switched (at i — 
0.83 sec.). From this figure, it is observed that the null projection remained negative 
until the switch time was reached, thus the effect of adding null motion was to reduce 
the singularity measure. From the torque projection plot, we see that torque produc- 



ing gimbal motion does not contribute appreciably to the singularity measure. A Iarae 
spike at the switch time is also observed in the torque projection plot, indicating a loss 
of control along the commanded torque direction. The reduction in m now is almost 
entirely due to the addition of of null motion. 

Gimbal angles are given in Figure 5-14, and both torque and non-torque produc- 
ing gimbal rates are shown in Figure 5-15. Large spikes are evident in the torque pro- 
ducing rates at the switch time, as would be expected, since the system is nearly 
singular in the direction commanded after the switch. From the null motion plots, it is 
seen that the magnitude of the null motion is zero at the switch point, since all Jacobi- 
an minors are singular. This is clearly seen in Figure 5-16. 

5.5 CONCLUSION 

We have shown that the inverse gain method is able to avoid the Elliptic singulari- 
ty. It has also been shown that the performance results of the second form of this 
method (which applies substantial null motion at high m states) arc superior to the first 
form (which applies most null motion when the magnitude ofm drops significantly). 
The calculated null-rates, how'ever, are still high for the second form. This feature, 
when combined with the property that the non-directional applied null motion may 
actually steer the system to a singularity (as was demonstrated in the non-constant 
requested torque simulation), make this approach inappropriate for application as a 
generic Steering law. 
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CHAPTER 6 


REDUNDANCY RESOLUTION VIA THE SINGULARITY ROBUST 

INVERSE (SR-INVERSE) 


6.1 INTRODUCTION TO THE SR-INVERSE 


The results of Chapter 5 indicated that real-time avoidance of internal Elliptic type 


singularities cannot be adequately accomplished using any of the available Steering 
laws or any of the proposed methods. It was seen 'hat the torque solution produced by 
the Moore- Penrose pseudoinverse eventually drives or restricts the system to a singular 
configuration. Since solving the torque equation exactly was demonstrated to drive the 
system directly to a singularity, one might surmize that if small torque errors are 


allowed, it may become possible to avoid these types of singularities. This strateg; 
presumes that the Outer controller (see Chapter 3) is structured to accomodate error 
m requested torque during attitude maneuvers. These errors can be considered to b< 
disturbance torques, and compensated through appropriate feedback. 


One method of accomplishing this is provided by the Singularity Robust inverse 
(SR-in verse), proposed for manipulators in [21] as an alternative to me Moore-Penrose 
pseudoinverse. Using this method, an approximate output torque close to the desired 
torque can be generated, even when the Jacobian matrix is singular. Accuracy of solv- 
mg the torque equation is traded with feasibility of the solut.on (,.e. gimbal rates 

remain finite and bounded in exchange for the build up of torque error near a singular 
configuration). 


I he SR-invcrsc is obtained by solving the following minimization problem: 


no 




min 


.-•/lere e 


- jd 


' if, COD' 
.COD . 


Setting \\\ equal to the identity matrix. (IF, = i). and IF, - K \, the SR-imerse is 


obtained: 


r = j\jj + k\ 


The particular solution can be written in terms of the SR-inversc as: 


9 P = J T (JJ‘ + Ml) I 


6.2 PROPERTIES OF SR INVERSE 

The particular solution obtained using this method is still orthogonal to the homo- 
geneous solution. This is easily shown by evaluating the inner produ t of the two sol- 
utions: 

< if p.0„ > =6$ •£„ = /.( J J r + K 1) ' J y = " 

The above rclat.on holds, since J y = 0 by definition of the null-vector. The robust- 
ness property of this method generates feasible solutions to the torque equation even at 



or in the neighborhood of singular points. At singular points, the pseudoinverse 
becomes singular, (i.e. results in infinite rate solution), whereas the SR-inverse still 
returns a finite rate solution. It is seen that the pseudomverse is identical to the SR-in- 
verse with k = 0. The scalar weighting factor k expresses the tradeoff between exact- 
ness and feasibility of solution. For small values of k, a small error is introduced in the 
torque solution. Small values of k also yield large rate magnitudes in the neighborhood 
of singular states. As k grows, however, the torque error calculated near a singular 
state increases and the calculated gimbal rates decline. 

The SR-inverse approach, however, is not without shortcomings. The most crucial 
problem is that if the system docs become singular using this method, and a torque is 
requested along the singular direction, the SR-inverse is unable to generate non-zero 
torque producing gimbal rates. The system could then be trapped in the singular state. 
This property is shown by the Singular Value Decomomposition of the SR-inverse, 
which for the 4-CV1G system is: 


r = VW T 


( 6 - 2 ) 


where E* 


a\ + K 


0 

0 

0 


() 

0 

<*3 


0 

0 


a\ + k 


0 


u 

V 


Matrix (3x3) of left singular vectors ( span range space of J ) 
Matrix (4x4) of right singular vectors ( span domain space oj J 


( sing (6-3), the particular solution (6-2) can be written as: 
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(6-4) 


t P = Vl a U T r 

If the torque request i lies along one of the column vectors of U, the gimbal rates 
computed by the SR-inverse are given by: 

dp = — ! V; (6-5) 

a\ + k 

From (6-5), it is seen that if one of the singular values, a„ is zero (i.e. system is singu- 
lar) and the torque request is along the left singular vector, u, , corresponding to this 
singular value, the output becomes zero. In this case, the gimbals will not move, thus 
trapping the system in the singular configuration. Unless this singularity allows escape 
by null motion (as discussed in Chapter 4), there is no possibility of removing the sys- 
tem from the singular configuration. 

6.3 DETERMINATION OF WEIGHTING F VCTOR 

To overcome the problem of conflicting requirements on the value of the weighting 
factor, it is made to vary with the nearness to singularities. In this way, k will have a 
large value near singularities, and small or zero value away from singularities. The 
weighting factor is thus chosen in the following manner: 


113 


IF m > m CR THEN 

K = 0 

ELSE 

& -W < “max THEN 
*0 

K = — 

ELSE 

K = *max 

where m CR = Critical value of rn 
K' 0 = Constant 

K max = Maximum value of weighting factor 

In this fashion, the weighting factor is adjusted according to distance from singularity 
by inversely scaling with the singularity measure. The reason for the applied maximum 
value is to prevent the determinant of the square Jacobian matrix ( J J T + k \ ) from 
becoming too large; in this case, the torque producing rates would correspondingly 
grow very small, which would require an extended period of time for the gimbai angles 
to change. By imposing an upper limit, the response of the system is essentially speed- 
ed-up. 


6,4 SINGUL ARITY AVOIDANCE PROPERTIES OF SR-INVERSE 

In order to examine the singularity avoidance properties of the SR-inverse, simu- 
lations similar to those in Chapter 5 have been carried out. The SR-inverse is com- 
puted numerically, using the symbolic inverse of the square Jacobian matrix. Results 
(rom four different simulations arc presented in this section; these are: 
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a) SR-Invarse 

b) SR-Inverse With First Gradient Method 

c) SR-Inverse With Second Gradient Method 

d) SR-Inverse With Second Inverse Gain Method 

All simulations used the same parameters as given in Chpa.er 5. The eritical value of 
the singularity measure was chosen as =10, with constant k„ = 0.1 . The plot- 
ted percent torque error is Je.ermmed from the di, Terence between requested mpu, and 

C\1G output torque, i.e.: 

% Torque Error — 100 ( i — J&p) 
where 8 P is determined from (6-2). 


6.4.1 SR-Inverse 


The results of this simula.ton arc shown in Ftgure 6-2. The max, mum allowed 
talue of the weighting constant was k„„ = 0.2 The plots clearly show that the Blip 
,ic singularity is not avoided. It is evident that even though m-0, the determinant of 
the square Jacob, an matrix {SQJ DEI ) remains nonzero. Thts illustrates a lundamcn- 
,al property of the SR-, overset gimbal rates can still be computed when the Jacobian 
matrix is stngular. The value ofK { SRJSV QMS) is noted to increase as the singu- 
larity is approached in order to allow the square Jacobian matrtx to be .averted (see 
,6-2)). From the g.mbal angle plots. ts seen .ha, gtmbals *2 and *4 remain station- 
ary, as was also the case for the Moore- Penrose pseudoinverse method. Thts result 
indicates tha, the SR-inverse sinularly cannot avokl Elliptic type singular!, tes wtthou. 



assistance, essentially because the primary difference between the SR and the M-P 
inverse is in the magnitude of the particular solution. The "direction” is still the same 
(i.e. orthogonal to null-space), as illustrated in Figure 6-1, for a one-dimensional row 
and null space. 


e N 



Figure 6-1. Solution Space Visualization 


The complete torque equation solution is spanned by the row' and null space. The 
SR-inverse as well as the M-P inverse solutions lie in the row space. From Figure 6-1, 
it is seen that the only difference between the two is the length (or magnitude) of the 
torque producing gimbal rates. Because the SR-inverse tends to produce smaller gimbal 
rates near singular regions, it allows more time for the application of null motion, thus 
introduction of null motion may prove more effective, as will be demonstrated below. 
Since the primary effect of the SR-inverse is along the direction of commanded torque, 




the SR-in verse applied without null motion is indeed expected to have analogous singu- 
larity avoidance properties to the M-P inverse, as was demonstrated in Figure 6-2. 

6.4.2 SR-Inverse With First Gradient Method 

The simulation results for this method are shown in Figure 6-3. The weighting 
constant was limited at K m „ = 0.2 . From Figure 6-3, it is seen that the singularity is 
again not avoided. The reason for this is the same as that given in Chapter 5 for the 
M-P inverse with this gradient method; essentially no null motion was added because 
the gimbal angle trajectory remained at a local m-extremum. From Figure 6-3 it is seen 
that gimbals U2 and #4 do not move, allowing the system to become singular at 
H x = 1.15. 


6.4.3 SR-Inverse With Second Gradient Method 


Simulation results for this approach are shown in Figures 6-4 through 6-6 . The 
weighting factor was limited at K max = 5 , although this limit was not neccessarv in this 
case, since k remained under 0.28, as can be seen from Figure 6-4. Since the singularity- 
measure remains well above zero in this test, the singularity has been avoided. From 
the momentum component plots ( HX, HY, HZ), it is seen that the momentum trajec- 
tory is diverted about the singularity, causing about 70% torque error in the .V-direc- 
tion, and considerably smaller errors about the Y and Z axes. The effect of null motion 
was to alter the Jacobian matrix, thus enabling the SR-inverse to generate finite ofT- 
axis torque errors that aided in skirting the singularity. Singularity avoidance is accom- 
plished by not forcing the system to go directly through the singular momentum state. 
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A complimentary reason for the avoidance is clear if we compare the ^V-momentum 
plots of this approach with those of the inverse gain method in Chapter 5 
(Figure 5-10), where one can see that the SR-inverse solution lags the inverse gain sol- 
ution. At t — 3 sec., the difference in momentum between the two methods is approxi- 
mately 0.6 units. This illustrates the explanation given earlier; i.e. the response is 
slowed down sufficiently to allow more time for null motion to act. Given enough time 
for reconfiguration by null motion at each simulation interval, the singularity measure 
could approach its global maximum. In this way, the gimbal angles are free to follow a 
globally maximum singularity measure trajectory, as opposed to a locally maximum 
trajectory that is generated by gradient methods. Following a globally maximum trajec- 
tory provides a superior means of accomplishing singularity avoidance. 

From Figure 6-5, it is seen that both gimbals #2 and #4 are moved in this case, 
allowing gimbal #2 to be "unlocked" from its anti-parallel orientation. From the minor 
plots, it is seen that only one minor (M 2 ) becomes 'ingular at t = 1.15 sec. Looking at 
1 igure 6-6, it is seen that both torque and non-torque producing rates have reasonable 
magnitudes (not exceeding 1.8 rad, 'sec); by avoiding the singularity, the requirement for 
small gimbal rates is implicitly met. 

6.4,4 SR-inverse With Second Inverse Gain Method 

Simulation results for this method are shown in Figures 6-7 through 6-9 . The null- 
constant ( MILL CONSTANT ) was limited to / m „ = 3, in order to limit the magni- 
tude of null-gimbal rates. The maximum allowed SR weighting factor was K m „ = 1 
Enforcing this maximum value was again not necessary in this case, as can be seen 
from the SR-inverse gain plot in figure 6-7. The singularity measure plot, also on this 
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Figure 6-4. Simulation Results For SR-lnverse With Second Gradient 
Method (Part 1 of 2) 
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Figure 6-4. Momentum Trajectory And Torque Errors For SR-lnverse With 
Second Gradient Method (Part 2 of 2) 
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page, indicates that the singularity is again avoided. The maximum torque error intro- 
duced via the SR-in verse is approximately 25% in the Af-direction, when the system is 
near the singularity. Comparing results obtained in Chapter 5 with the second inverse 
gain method using the M-P inverse (Figure 5-10), it is observed that both the null-con- 
stant and torque solution projection are smaller for the SR-in verse approach. Because 
of the torque errors introduced by the SR-inverse in the singular region, however, a lag 
of 0.2 units is evident in the A'-momentum plot for the SR-inverse. The gimbal angles 
and minors are shown in Figure 6-S. Near the singular momentum state ( 
//, — 1.15, t = 1.15 sec . ), it is seen that none of the minors are singular, 1 e. are zero. 

Comparing the gimbal rates from this approach, shown in Figure 6-9, to those 
analogously obtained from the M-P inverse, the peak torque producing gimbal rates 
calculated by the SR method are seen to be approximately 0.4 rad sec smaller. The null 
rates, however, are essentially the same. 
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6.5 NON CONSTANT TORQUE REQUEST SIMULATION 

In this simulation, the same non-constant torque request used in Chapter 5 for the 
M-P inverse with the second inverse gain method is applied to the SR-inverse equipped 
with the same null algorithm. Simulation results are shown in Figures 6-l<t through 
6-12 . The maximum allowed SR weighting factor was K mu = 0.2, while the maximum 
value of the null-constant was /. nM = 3. From Figure 6-10, it is seen that the system 
is driven to a singular state, even though the SR-inverse is used. It is also observed 
that at the singularity any null motion is inellective since the null projection there is 
/cro. The reason for this is that the null vector is identically zero at this singularity. 
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Figure 6-7. Simulation Results For SR With Second Inverse Gain Method (Part 
1 of 2) 
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Figure 6-7. Momentum Trajectory And Torque Error For SR With Second 
Inverse Gain Method (Part 2 of 2) 
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Figure 6-8. Gitnbal Angles For SR With Second Inverse Gain Method (Par, 1 of 
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Figure 6-8. Jacobian Minors For SR With Second Inverse Gain Method (Pan 2 
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Figure 6-9. Null Gimbal Rates For SR With Second Inverse Gain Method 
(Rad/Sec) (Part 2 of 2) 
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since all Jacobian minors are zero (see Figure 6-11). The momentum trajectory and 
torque errors are shown in Figure 6-10, from which it is seen that substantial torque 
errors are generated by the SR approach. Comparing Figures 6-10 and 5-14. we 
observe that the system remains singular for a longer period using the SR method, 
whereas the torque projection spike in Figure 5-14 is at least an order magnitude larger 
than the corresponding spike for the SR method, creating proportronally larger rorque 

producing gimbal rates. The difference in momentum trajectory followed by borh moth- 
ods is clearly evident from this comparison. 


From Figure 6-11, we observe that all minors are simultaneously zero for a sub- 
slant, al period of time. Comparing the minor plots in this figure to those in 
figure 5-16, it is seen that the minor trajectories for both methods are essemiallv the 
same up to the switch time (0.83 sec.), and very different afterwards. A s.milar effect is 
seen when comparing gimbal angle trajectories in Figures 6-11, 5-14, 


The superior performance of the SR approach is evidem from the results 
Figure 6-12. From this figure, it is seen that the peak rorque producing gimbal rarcs do 
nor exceed 1.4 rad sec. as compared to 7.4 rad sec for the M-P based method in 
figure 0-13. |„ addition, the SR-invcrsc is not seen to generate large spikes in gimbal 
rates that were noted the M-P resulrs. The null-rares for the SR method arc sign, ft 
's-mrly smaller, as also seen in these plots. This is due to the different gimbal angle rra- 
jecrory rhar .he M-P method followed after the switch time, which resulted in a higher 
singularity measure stare, as well as higher value, for the minors. In conclusion, the 
superior performance of .he SR based method over the corresponding M-P based 
approach is dearly evident from this simulation. As discussed before, however, if ,he 
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requested torque direction at the switch time was along the singular direction corre- 
sponding to the singular momentum state, the SR approach would not have been able 
to extract the system from the singular configuration, since zero torque producing rates 
are generated. 


6.6 CONCLUSION 


It has been shown that the SR-invcrse is able to avoid the Elliptic singularitv at 
H x = 1-15 only when equipped with an appropriate null motion algorithm. The supe- 
rior performance of this method has also been shown for a case requiring a non-con- 
stant torque. The general singularity avoidance property of the SR-inverse has also 
been discussed, and it has been shown that the prime mechanism by which this method 
avoids singularities is by slowing the system response to an input torque request in the 
neighborhood of a singularity, allowing more time for null motion to be applied. In 
terms of the mechanical analog, the cnd-elTector velocity is reduced before reaching the 
singularity, allowing a longer interval over which null motion can be performed. The 
SR-inverse can also introduce finite torque errors orthogonal to the requested torque 
direction; although these errors aid in skirting the singular region, the slow-down along 
the commanded axis, coupled with null motion, provides the most significant effect. 
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Figure 6-10. Momentum Trajectories And Torque Errors For Non-Constant 
Torque Request (Part 2 of 2) 
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CHAPTER 7 


CONCLUSIONS AND RECOMMENDATIONS 


In this thesis, the problem of spacecraft attitude control using redundant single 
gimbal CMGs has been investigated. Specifically, the singularity problems associated 
with a 4-CMG system has been examined, in addition to the formulation of a general 
torque based Steering law for redundancy resolution. A Steering law using the SR-in- 
verse with appropriate null motion has been shown to provide a promising approach to 
singularity avoidance; by not restricting the system to produce the exact torque 
request, singular CMG configurations are avoided. 

In Chapter 2. single gimbal CMG fundamentals were reviewed, and the mechanical 
analog to the CMG system, the robotic manipulator, was proposed. It was shown that 
both systems possess similar difficulties with singular configurations, and that results 
from one area may be applicable to the other. A simple method of generating an 
orthogonal null-space basis to the Jacobian matrix was also presented. 

In Chapter 3, the control architecture for spacecraft equipped with single gimbal 
CMGs was reviewed. A dual-level control structure using an Outer and Inner Control 
loop was discussed, as well as the desirability of the Outer control loop to accomodate 
occasional errors in torque delivered by the CMG system. 

In Chapter 4. the singular states of single gimbal CMGs were classified, and a test 
for null motion near a singularity was presented. Examples of the different types of sin- 
gularities were presented for both the CMG system and a planar manipulator. I he 
singularity measure and its relationship to the null-space of the Jacobian was exam- 


133 


ined. It was shown that the magnitude of the non-singular Jacobian null-space vector 
is identical to the singularity measure. 

In Chapter 5, various torque-input Steering laws were reviewed, and alternative 
singularity avoidance methods based on the Moore-Penrose pseudoinverse were pre- 
sented. It was shown that existing singularity avoidance methods do not avoid Ellip- 
tic-type internal singularities. Although the inverse gain method was shown to 
generally avoid this type of singularity, it may nonetheless still drive the system toward 
a singular configuration due to its nondirectional nature, as was demonstrated. The 
results of this chapter indicated that reliable real-time avoidance of internal Elliptic- 
type singularities cannot be accomplished using any of the available Steering laws or 
any of the proposed methods. 

In Chapter 6, the SR-inverse was introduced as an alternative to the Moore-Pen- 
rose pseudoinverse. It was shown that this inverse can avoid Elliptic-type internal sin- 
gularities when equipped with an appropriate null motion algorithm. The superior 
performance of this method was demonstrated for a non-constant torque request; its 
singularity avoidance characteristics surpassed those presented in Chapter 5, and gim- 
bal rates calculated using this method were generally smaller. It was noted, however, 
that if the system was driven to a singular state using this approach, and a torque is 
requested along the singular direction, the SR-inverse can only generate zero torque 
producing gimbal rates, thus trapping the system in the singular state unless the singu- 
larity is escapable by null motion. 


\ 
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For a completely general SR-inverse based Steering law the form of the null-algor- 
ithm needs to be investigated further, since the performance of this approach is directly 
related to the specific form of null-algorithm used in conjunction with the SR-inverse. 
To overcome the problem of being trapped in a singular state when a torque along the 
singular direction is requested, momentary torque errors could be introduced such that 
the SR-inverse is able to drive the system out of the singular state. The projection of 
the null-vector onto the gradient of the singularity measure may prove useful in resolv- 
ing the nature (i.e. escapable non-degenerate or unescapable degenerate) of Hyperbolic 
f 

\ singularities. 
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